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(57) A model's ZMP (full-model's ZMP) is calculated 
using a dynamic model (inverse full-model) 100c2 that 
expresses a relationship between a robot movement 
and floor reaction, a ZMP -con verted value of full model's 
corrected moment about a desired ZMP is calculated or 
determined based on a difference (full-model ZMP's er- 
ror) between the calculated model's ZMP and the de- 
sired ZMP, whilst a corrected desired body position is 
calculated or determined. Since the robot posture is cor- 
rected by the calculated ZMP-converted value and the 
corrected desired body position, the corrected gait can 
satisfy the dynamic equilibrium condition accurately. 
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Description 

TECHNICAL FIELD TO WHICH THE INVENTION RELATES TO 

5 [0001 J The present invention relates to a motion generation system of a legged mobile robot, and more particularly 
to a system for generating or determining a motion of a legged mobile robot and to control the robot to follow up the 
generated motion. 

BACKGROUND ART OF THE INVENTION 

to 

[0002] The gait of a legged mobile robot has hitherto been generated by trial and error using a strict dynamic model 
of the legged mobile robot. As a result, it has been difficult to generate a gait on a real-time basis. For that reason, the 
applicant proposes, in Japanese Laid-Open Patent Application No. Hei 10 (1998)-86081, conducting gait generation 
freely by converting a set of standard gaits, designed with the use of an off-line computer, into a set of time-series data 
i* including parameters and a body trajectory to be stored in a memory of a microcomputer mounted on a robot, and by 
calculating a weighted average of Instantaneous values of individual gaits whose parameters relating to time such as 
a walking period are the same, 

[0003] However, since a gait Is calculated through approximation In the proposed technique, the generated gait falls, 
occasionally, to satisfy the dynamic equilibrium condition. It should be noted here that the "dynamic equilibrium con- 

20 dition" Indicates a situation where a ZMP determined from the gravity and Inertia! force of a desired gait using a strict 
dynamic model (that expresses behavior of the robot strictly) is equal to a desired ZMP. To be more specifically, it 
indicates a sit uation where horizontal component of a moment produced about the desired ZM P by the resultant force 
of the determined inertial force and gravity of the robot using a strict dynamic model (that expresses behavior of the 
robot strictly) Is zero, ("walking robot and artificial foot" (written by M. Vukobratovlc and translated by Kato and Yamas- 

25 hita); published on 1 975 by The Nikkan Kogyo Shimbun Kabushiki Kaisha). 

DISCLOSURE OF THE INVENTION 

[0004] A first object of the present invention Is to eliminate the drawback of the above-mentioned technique proposed 
30 by the applicant, and to provide a motion generation system of legged mobile robot, In which a generated motion in a 
gait and the like can satisfy the dynamic equilibrium condition with accuracy. 

[0005] A second object of the present invention is to provide a motion control system of legged mobile robot, in which 
a generated motion In a gait and the like can satisfy the dynamic equilibrium condition with accuracy, and can improve 
posture stability of the robot by controlling the robot to follow up the generated motion. 

35 [0006] In order to achieve the first and second objects, the present invention provides a system for generating an 
instantaneous value of motion including walking of a legged mobile robot having at least a body and a plurality of legs 
each connected to the body, when the robot performs the motion, comprising: provisional instantaneous value deter- 
mining means for determining provisional instantaneous values of a desired movement and a desired floor reaction 
force or ZMP that constitute the motion; model floor reaction force calculating means for calculating a model's floor 

to reaction force or ZMP based on at least the determined provisional instantaneous value of the desired movement, 
using a dynamic model that expresses a relationship between the movement of the robot and a floor reaction force or 
ZMP; difference calculating means for calculating a difference between the calculated model's floor reaction force and 
the determined provisional instantaneous value of the desired floor reaction force, or a difference between the calcu- 
lated model's ZMP and the determined provisional instantaneous value of the desired ZMP; and desired Instantaneous 

45 value determining means for determining desired instantaneous values of the desired movement and the desired floor 
reaction force, by correcting at least the provisional Instantaneous value of the desired movement based on at least 
the calculated difference. 

[0007] Since the system Is arranged such that, provisional Instantaneous values of a desired movement and a desired 
floor reaction force or ZMP that constitute the motion are determined, a model's floor reaction force or ZMP is then 

50 calculated based on the determined provisional instantaneous value of the desired movement, using a dynamic model 
that expresses a relationship between the movement of the robot and a floor reaction force or ZMP, a difference between 
the calculated model's floor reaction force and the determined provisional instantaneous value of the desired floor 
reaction force, or a difference between the calculated model's ZMP and the determined provisional Instantaneous value 
of the desired ZMP is then calculated; and desired instantaneous values of the desired movement and the desired 

55 floor reaction force are determined, by correcting at least the provisional instantaneous value of the desired movement 
based on the calculated difference. With this, the system can generate a motion such as a gait that satisfies the dynamic 
equilibrium condition accurately, and can Improve the stability during walking or operation. 

[0008] Furth er, in orderto achieve the second object, the present invention provides a system for generating a motion 
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including walking of a legged mobile robot having at least a body and a plurality of legs each connected to the body, 
comprising: desired movement determining means for determln ing a desired movement that defines the motion; desired 
floor reaction force calculating means for calculating a desired floor reaction force based on at least the determined 
desired movement, using a dynamic model that expresses a relationship between the movement of the robot and a 
5 floor reaction force; and floor reaction force controlling means for controlling the floor reaction force actually acting on 
the robot based on at least the calculated floor reaction force. 

[0009] Since the system is arranged such that, a desired movement that defines the motion is determined, a desired 
floor reaction force is then calculated based on the determined desired movement, using a dynamic model that ex- 
presses a relationship between the movement of the robot and a floor reaction force, and the floor reaction force actually 
10 acting on the robot is controlled based on the calculated floor reaction force. With this, the system can generate a 
motion such as a gait that satisfies the dynamic equilibrium condition accurately, and can improve the posture stability, 
by controlling the robot to follow up the generated motion. 

BRIEF DESCRIPTION OF THE DRAWINGS 

15 

[0010] 

Figure 1 is a schematic view showing an overall configuration of a legged mobile robot, more particularly a biped 

robot, to which a motion generation system of a legged mobile robot according to an embodiment of the present 
20 invention is applied; 

Figure 2 is an explanatory side view showing the structure of thefoot of a legged mobile robot illustrated in Figure 1 ; 

Figure 3 is a block diagram showing details of a control unit mounted on the robot illustrated In Figure 1 ; 

Figure 4 is a block diagram showing the configuration of a motion control system Including the motion generation 

system of a legged mobile robot illustrated in Figure 1 in a functional manner; 
25 Figure 5 is a block diagram functionally showing a gait generator (with full-model correction) illustrated in Figure 4; 

Figure 6 is an explanatory view showing a multiple-material-point model that is an example of a full-model in the 

gait generator (with full-model correction); 

Figure 7 is an explanatory view showing a simplified model (dynamic modei) that approximates the legged mobile 
robot illustrated in Figure 1 by an inverted pendulum to be used by the gait generator (with full-model correction) 
30 illustrated in Figure 5; 

Figure 8 is a block diagram showing dynamic calculation conducted by a gait generator (proposed in an earlier 
patent application) with the use of the model Illustrated in Figure 7; 

Figure 9 is a set of time charts showing a trajectory of a point of action P of the resultant force of the inertial force 
and gravity of the leg's material point, to be used in calculating a pseudo ZMP value ZMPpend indicative of a 
35 supporting point of the inverted pendulum in dynamic calculation illustrated in Figure 8; 

Figure 1 0 is an explanatory view showing asituation where a trajectory of the body of the robot (illustrated in Figure 
1 ) diverges; 

Figure 11 is a flow chart showing the operation of the motion generation system of a legged mobile robot illustrated 
in Figure 1 ; 

40 Figure 1 2 is an explanatory view explaining a steady turning gait (to be used in the processing in the flow chart of 

Figure 11) from a robot foot landing position and the like; 

Figure 1 3 is an explanatory view explaining a body trajectory of the steady turning gait (to be used in the processing 
in the flow chart of Figure 11) from the robot foot landing position and the like; 

Figure 14 is a subroutine flow chart showing the generation of desired instantaneous values referred to in the flow 

45 chart of Figure 11 ; 

Figure 15 is a table showing variations or modifications of the gait correction conducted In the first to twentieth 
embodiments of the motion generation system of a legged mobile robot according to the present invention; 
Figure 16 Is a functional block diagram showing the gait correction conducted in the motion generation system of 
the first embodiment of the motion generation system of a legged mobile robot according to the present invention; 

so Figure 17 is a functional block diagram showing the gait correction conducted in the motion generation system of 

a (egged mobile robot according to a second embodiment of the present invention; 

Figure 13 a block diagram showing the dynamics calculation using a perturbation model to be used in the gait 
correction conducted in the motion generation system of a legged mobile robot according to the second embodi- 
ment of the present invention; 

55 Figure 19 is a functional block diagram showing a modification of the gait correction conducted in the motion 

generation system of a legged mobile robot according to the second embodiment of the present invention; 
Figure 20 is a functional biock diagram similarly showing a modification of the gait correction conducted in the 
motion generation system of a legged mobile robot according to the second embodiment of the present invention; 
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Figure 21 is a functional block diagram similarly showing a modification of the gait correction conducted In the 
motion generation system of a legged mobile robot according to the second embodiment of the present Invention; 
Figure 22 is a functional block diagram similarly showing a modification of the gait correction conducted In the 
motion generation system of a legged mobile robot according to the second embodiment of the present invention; 
Figure 23 is a functional block diagram showing the gait correction conducted In the motion generation system of 
a legged mobile robot according to a third embodiment of the present invention; 

Figure 24 is a functional block diagram showing the gait correction conducted in the motion generation system of 
a legged mobile robot according to a fourth embodiment of the present Invention; 

Figure 25 is a functional block diagram showing the gait correction conducted In the motion generation system of 
a legged mobile robot according to a fifth embodiment of the present invention; 

Figure 26 is a functional block diagram showing the gait correction conducted In the motion generation system of 
a legged mobile robot according to a sixth embodiment of the present Invention; 

Figure 27 is a functional biock diagram showing the gait correction conducted in the motion generation system of 
a legged mobile robot according to a seventh embodiment of the present invention; 

Figure 28 Is a functional biock diagram showing the gait correction conducted in the motion generation system of 
a legged mobile robot according to an eighth embodiment of the present invention; 

Figure 29 is a functional block diagram showing the gait correction conducted in the motion generation system of 
a legged mobile robot according to a ninth embodiment of the present invention; 

Figure 30 is a functional block diagram showing the gait correction conducted in the motion generation system of 
a legged mobile robot according to a tenth embodiment of the present Invention; 

Figure 31 is a functional block diagram showing the gait correction conducted In the motion generation system of 
a legged mobile robot according to an eleventh embodiment of the present invention; 

Figure 32 is a functional biock diagram showing the gait correction conducted In the motion generation system of 
a legged mobile robot according to a twelfth embodiment of the present invention; 

Figure 33 is a functional block diagram showing the gait correction conducted in the motion generation system of 
a legged mobile robot according to a thirteenth embodiment of the present invention; 

Figure 34 is a functional block diagram showing the gait correction conducted in the motion generation system of 
a legged mobile robot according to a fourteenth embodiment of the present Invention; 

Figure 35 Is a set of time charts explaining re- determination conducted in the gait parameters succeeding to the 
gait correction of the motion generation system of a legged mobile robot according to the fourteenth embodiment 
of the present invention; 

Figure 36 is a functional block diagram showing the gait correction conducted in the motion generation system of 
a legged mobile robot according to a fifteenth embodiment of the present invention; 

Figure 37 is a functional biock diagram showing the gait correction conducted in the motion generation system of 
a legged mobile robot according to a sixteenth embodiment of the present invention; 

Figure 38 is a functional block diagram showing the gait correction conducted in the motion generation system of 
a legged mobile robot according to a seventeenth embodiment of the present invention; 

Figure 39 is a functional block diagram showing the gait correction conducted in the motion generation system of 
a legged mobile robot according to an eighteenth embodiment of the present invention; 

Figure 40 is a functional block diagram showing the gait correction conducted in the motion generation system of 
a legged mobile robot according to a nineteenth embodiment of the present invention; 

Figure 41 Is a functional block diagram showing the gait correction conducted In the motion generation system of 
a legged mobile robot according to a twentieth embodiment of the present invention; 

Figure 42 is a functional block diagram, similar to Figure 16, but showing the gait correction conducted in the 
motion generation system of a legged mobile robot according to a twenty-first embodiment of the present invention; 
Figure 43 Is a functional block diagram, similar to Figure 17, but showing the gait correction conducted In the 
motion generation system of a legged mobile robot according to a twenty-second embodiment of the present 
invention; 

Figure 44 is a functional block diagram, similar to Figure 37, but showing the gait correction conducted in the 
motion generation system of a legged mobile robot accordingto atwenty-third embodiment of the present invention; 
Figure 45 Is a functional block diagram, similar to Figure 34, but showing a modification of the twenty-third em- 
bodiment; and 

Figure 46 Is a functional block diagram, similar to Figure 5, but showing an equivalent modification of the first 
embodiment, etc. 

DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 



[0011] The motion generation system of a legged mobile robot according to the present Invention will be explained 
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with reference to the accompanied drawings. A biped robot is taken as an example of the legged mobile robot. 
[0012] Figure 1 Is an overall schematic view showing a legged mobile robot, more specific, a biped robot to which 
the motion generation system according to the present invention is applied. 

[0013] As illustrated in the figure, a biped robot (hereinafter simply referred to "robot") 1 has a pair of right and left 
5 legs (leg links) 2 each composed of si:x Joints. The six joints include, arranged successively downward, a pair of hip 
joints 10R, 10L (the right-hand joint is indicated by R and the left-hand joint by L) for rotating legs with respect to hips, 
a pair of hip joints 12R, 12L in the rolling axis (about an X-axis), a pair of hip joints 14R, 14L in the pitching axis (about 
a Y-axis), a pair of knee joints 16R, 16L in the pitching axis, a pair of ankle joints 18R, 18L in the pitching axis, and a 
pair of joints 20R, 20L in the rolling axis. 
10 [0014J The robot is provided with feet 22R, 22L underneath of the joints 18R(L) and 20R(L), and a body (trunk) 24 
at its top which houses a control unit 26 comprising microcomputers (explained later). In the above, the joints 1 0R(L), 
12R(L), 14R(L) make up the hip joints, and the joints 18R(L), 20R(L) make up the ankle joints. The hip joints and knee 
joints are connected to each other by thigh links 28R, 28L, and the knee joints and ankle joints are connected to each 
other by crus or shank links 30R, 30L. 
r5 [0015] Further, two arms are connected at upper parts of the body 24 and a head is provided at the top of the body 
24. However, since the upper configuration does not have direct relationship with the gist of the present invention, the 
illustration is omitted. 

[0016] With the above structure, each of the legs 2 is given six degrees of freedom. When the 6*2= 12 joints are 
driven to suitable angles during walking, a desired motion is imparted to the entire leg structure to enable the robot to 
20 walk arbitrarily in a walking environment of three-dimensional (absolute) space. (In the specification, "*" represents 
multiplication in scalar calculation and outer product in vector calculation.). 

[0017] it should be noted that a position and a velocity of the body 24 indicate a position and its displacement velocity 
of a predetermi ned position of the body 24, specifically a representative point of the body 24. This will be referred to later. 
[0018] As shown in Figure 1 , a known force sensor (more precisely, known as the six-axis force and torque sensor) 

25 34 is disposed at a position below each ankle joint for generating a signal indicative of three directional components 
Fx, Fy r Fz offeree and three directional components Mx, My, Mz of torque or moment thereby of the force and outputs 
a signal indicative of foot landing and the floor reaction force (the load acting from the floor). Moreover, the body 24 
has an inclination sensor 36 which generates a signal indicative of inclination with respect to a Z-axis (the vertical 
direction (the direction of gravity)) and i(:s angular velocity. The electric motors of the respective joints are coupled with 

30 respective rotary encoders which generate signals indicative of angular displacements or rotation amounts of the elec- 
tric motors. 

[0019] As illustrated in Figure 2, a spring mechanism 38 is installed at a position upward from the foot 22R(L), which 
constitutes a compliance mechanism 42 together with a sole elastic member 40 attached to the sole of the foot 22R 
(L). The spring mechanism 38 has a box-like guide member (not shown) connected to the foot 22R(L), and a piston 

35 member (not shown) connected to the side of the ankle joint 18R(L), 20R(L) and the force sensor 34 and inserted In 
the guide member with an elastic member such that it moves in the guide member to a slight extent. 
[0020] In the figure, the foot 22 R(L) illustrated in thicklines shows acondition where nofioor reaction force is imparted. 
When subjected to the floor reaction force, the spring mechanism 38 and the sole elastic member 40, which constitute 
the compliance mechanism 42, deform such that the foot 22R(L) shifts to the position and posture illustrated in dashed 

40 lines. This configuration is significant not only for decreasing the foot-landing impact, but also for enhancing the control 
performance Since this configuration is disclosed in an application (Japanese Laid-Open Patent Application No. Hel 
5 (1 993) - 305584) proposed by the applicant, no further explanation will be made. 

[0021] Although not shown in Figure 1 , a joystick 44 is provided at an appropriate location of the biped robot 1, which 
enables an operator from the outside to input a demand on gait, such as changing from straight advance to turning. 
43 [0022] Figure 3 is a block diagram which shows the details of the control unit 26 comprised microcomputers. Outputs 
from the inclination sensor 36, etc., are converted Into digital signals by an A/D converter 50 and are then transmitted 
through a bus 52 to a RAM 54. Output signals from the rotary encoders that are disposed adjacent to the respective 
electric motors are transmitted through a counter 56 to the RAM 54. 

[0023] The control unit 26 includes a first arithmetic unit 60 and a second arithmetic unit 62 respective of which 
50 comprises a CPU. As will be explained later, the first arithmetic unit 60 conducts the gait generation, calculates joint 
angle displacement commands, and outputs the same to the RAM 54. The second arithmetic unit 62 reads the com- 
mands and the detected values from the RAM 54 : and calculates values (manipulated variables), and outputs the same 
through a D/A converter 66 and servo-amplifiers to the electric motors which drive the respective Joints. 
[0024] Figure 4 is a block diagram showing overall configuration and operation of the motion generation system of 
55 legged mobile robot according to the embodiment. 

[0025] Explai ning this, the system includes a gait generator (with full-model correction) 1 00 which generates a desired 
gait freely and on a real-time basis and outputs them as will be explained later. The desired gait comprises a desired 
body posture (trajectory or pattern), a corrected desired body position (trajectory or pattern), a desired foot position 
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and posture (trajectory or pattern), a desired ZMP (desired total floor reaction force central point) (trajectory or pattern), 
a ZMP-converted value of full-model's corrected moment about desired ZMP, and a desired total floor reaction force 
(trajectory or pattern). 

[0026J The floor reaction force acting on each foot 22R(L) is called a "foot floor reaction force", whilst the resultant 
5 force of the foot floor reaction forces acting on both feet is called a "total floor reaction force". Since the foot floor 
reaction force will rarely been referred to In the following, the "floor reaction force" will be used in the meaning of "total 
floor reaction force" if it is not specifically described. 

[0027] Explaining first the gait to be generated by the system, the robot 1 should have, as desired values in the 
control of locomotion, not only a desired movement (or motion) pattern, but also a desired floor reaction force pattern 

10 that satisfies the dynamic equilibrium condition against the desired movement pattern. 

[0028] The desired floor reaction force Is generally described or defined by a point of action and by a force and 
moment acting thereat. Since the point of action can be set at any point, desired floor reaction force has numerous 
descriptions. However, if the desired floor reaction force is described by selecting the aforesaid desired floor reaction 
force central point as the point of action, the moment of force Is zero except for Its vertical component. 

is [0029] As stated above, in a gait that satisfies the dynamic equilibrium condition, since the ZMP calculated from the 
desired movement trajectory and the desired floor reaction force central point are equal to each other, the desired ZMP 
trajectory can be used in lieu of the desired floor reaction force central point trajectory. 

[0030] Therefore, the above can be rewritten as; "the legged mobile robot should have, as desired values to be 
controlled its locomotion, not only the desired movement (or motion) pattern or trajectory, but also the desired ZMP 
20 trajectory (desired floor reaction force pattern)". 

[0031] Based on the above, the desired gait is defined In this specification as follows: 

a) The desired gait is, in a broad sense, a set of the desired movement (or motion) trajectories and the desired 
floor reaction force pattern extending over a period of a walking step or steps. 
23 b) The desired gait is, in a narrow sense, a set of the desired movement (or motion) trajectories and the ZMP 

trajectory extending for a period of a single walking step, 
c) A series of walking is comprised of a series of gaits. 

[0032] Hereinafter, for a more rapid understanding, the desired gait is used to represent that gait defined In the narrow 
so sense, unless it is mentioned to the contrary. Specifically, the desired gait is used to mean a gait extending for a period 
beginning from the initial state of a two-leg supporting period to the terminal state of a one-leg supporting period 
succeeding thereto. Here, needless to say, the two-leg supporting period means a period during which the robot 1 
supports its weight with two legs 2, whereas the one-leg supporting period means a period during which the robot 
supports its weight with one of the two legs (leg link) 2. The leg 2 which does not support the robot weight during the 
35 one-leg supporting period is called a "free leg". Since the definitions are described In detail in the Lald-Open Patent 
Application (Hel 10(1998)-86081) proposed earlier, no further explanation will be made. 

[0033] Specifically, the object of the present invention is to generate the desired gait defined above accurately and 
on a real-time basis such that a generated motion in a gaitsand the like can satisfy the dynamic equilibrium condition, 
thereby enabling stability of motion such as walking. 
to [0034] Here, conditions which a desired gait must satisfy will be explained. 

[0035] The conditions which the desired gait must satisfy will generally be classified into the following five: 

Condition 1) The desired gait must satisfy the dynamic equilibrium condition. In other words, the ZMP trajectory 
dynamically calculated from the desired movement trajectories of the robot 1 should accord with the desired ZMP 
is trajectory. 

Condition 2) When a demand(s) on stride, turning angle, etc., Is made by a locomotion planner or path planner 
(neither shown) of the robot 1 or Is Inputted by an operator, the desired gait must satisfy It. 
Condition 3) The desired gait must satisfy constraint conditions in kinematics that the robot foot must not dig or 
scrape the floor on which it walks, the joint angie must be within a movable range, the joint angular velocity must 
50 not exceed a permissible range, etc. 

Condition 4) The desired gait must also satisfy conditions of constraint In dynamics that the ZMP must remain 
within the foot sole floor-contact area during the one-leg supporting period, the joint torque must not exceed a 
possible maximum power of the joint actuators, etc. 

Condition 5) The desired gait must satisfy boundary conditions. As a matter of course, Condition 1) results in the 
55 boundary condition that the position and velocity of robot's each part such as the body must be continuous in the 

gait boundary. (If not, infinite force would occur or the ZMP would move far away from the foot soie floor-contact 
area). 
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[0036] More specifically, the initial state of n+1-th gait should correspond to the terminal state of n-th gait, especially 
in the body position, posture and velocity relative to the foot position. If the initial state of n+1 -th gait has been deter- 
mined it suffices if the terminal state of n-th gait will be accorded with the n+1 -th gait initial state. If not determined, it 
suffices if the terminal state of n-th gait will be within a range that ensures continuous walking without losing posture 
s stability. However, as will be discussed iater, it is quite difficult to determine the terminal state range which ensures 
continuous walking without losing posture stability. 

[0037] Generally speaking, the desired gait is generated by a gait generation algorithm including parameter values 
or time-series table data. (In other words, to determine a gait is to determine the parameter values or time-series table 
data appropriately.) 

w [0038] Various kinks of gaits can be generated by changing the parameter values ortime-series table data. However, 
if the parameters or time-series table data are determined without paying careful attention, It is not guaranteed if the 
generated gait can satisfy all of the conditions mentioned above. 

[0039] In particular, when generating a body trajectory that satisfies Condition 1 } based on the ZMP trajectory by a 
gait generation algorithm, even if a range, suitable for continuous walking, of the body position and velocity at the gait 
15 terminal is known, it is still difficult to determine the parameters of the ZMP trajectory in such away that both the body 
position and body velocity will fall within the range at the gait end. 
[0040] The reasons of the difficulty are as follows: 

Reason 1) The robot body tends, once begins to move away from the ZMP, to move farther away therefrom. 

20 This will be explained by an inverted pendulum model which approximates the behavior of the robot body. If 

the inverted pendulum's floor point (at which its center of gravity Is projected) deviates from the supporting point, 
the deviation will diverge and the pendulum will turn over. Even when it is turning over, the resultant force of the 
inertial force and gravity of the inverted pendulum continues to act on the supporting point (in other words, the 
ZMP is kept equal to the supporting point), and the resultant force remains balanced with the floor reaction force 

25 acting through the supporting point. The dynamic equilibrium condition can merely describe a relationship between 

the inertia) force and gravity and the floor reaction force of a moving object at every moment,. 

It is likely to misunderstand that continuous robot walking is ensured, when the dynamic equilibrium condition 
is satisfied. However, satisfaction of the dynamic equilibrium condition does not always ensure that the robot is at 
a stable posture. Like the center of gravity of the inverted pendulum tends, if begins to move away, to move further 

30 away, the center of gravity of the robot tends, once begins to move away from the position immediately above the 

ZMP, to move farther away therefrom. 

Reason 2) The one-leg supporting period requires that the ZMP must be within the supporting leg foot sole floor- 
contact area, etc. Due to rigid conditions of constraint like this, it is difficult to determine body acceleration and 
deceleration patterns freely. If the body patterns are determined mainly taking body position into account, the 
35 velocity is likely to deviate from a range, and vice versa. Thus, it is difficult to make both the position and velocity 

equal to desirable values at the same time. 

[0041 1 Continuing the explanation of the gait, the gait is described by gait parameters. The gait parameters comprise 
movement (or motion) parameters and the ZMP parameter (more generally floor reaction force parameter). The "floor 

40 reaction force parameter" is used in this specification to mean a parameter relating to the floor reaction force pattern 
with respect to time. The ZMP trajectory is expressed by a broken-line pattern as will be explained with reference to 
Figure 35 (referred to only In the X-coordinate in the figure) and is described or expressed with respect to the coordinate 
of X, Y and Z (directions) by the positions of the braking points and passing times of the pattern. 
[0042] The movement (or motion) parameters comprise foot (trajectory) parameters and the body (trajectory) pa- 

45 rameters. The foot trajectory parameters comprise initial free leg (foot lifting) position and posture, terminal free leg 
(foot landing) position and posture, and durations of the two-teg supporting period and the one-leg supporting period, 
etc 

[0043] The body trajectory parameters comprise parameters determining the body posture (the direction or inclination 
of the body 24 in space), parameters determining the body height (value in the Z-direction), parameters determining 

50 initial body position (displacement) and velocity, etc. 

[0044] Figure 5 is block diagram showing the gait generator (with full-model correction) 1 00 in details. 
[0045] As illustrated, the gait generator (with full-model correction) 1 00 has a gait parameter determinator 1 00a which 
determinesthe values (ortime-series taole) of the parameters In such a manner that they satisfy the aforesaid conditions 
that the desired gait must satisfy. The determined gait parameters are inputted to a desired (and provisional) instan- 

55 taneous value generator 1 00b which generates or calculates the desired foot position and posture, the desired ZMP 
and desired body posture, more precisely their desired instantaneous values and provisional instantaneous values at 
time t, based on the inputted values, using techniques proposed by the applicant in Japanese Laid-Open Patent Ap- 
plication Nos. Hei 5-318339 and Hei 5-324115. in the specification and figures, "posture" indicates an inclination or 
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direction (orientation) in space. 

[0046J It should also be noted that, for the sake of brevity, the desired body posture Is omitted from illustration In 
most figures including Figures. 

[0047] The generated (calculated) desired foot position and posture, the desired ZMP and the desired body posture 
(more precisely their desired and provisional instantaneous values) are Inputted to a full-model corrector 100c. The 
full-model corrector 1 00c has a simplified model 1 00c1 (proposed by the applicant In Japanese Patent Application No. 
2000-352011) and a full-model 100c2 (proposed in the present application and will be explained later), determines the 
desired body position (more precisely a desired horizontal body position) based on the simplified model and corrects 
the determined desired body position using the full-model (explained later). 

[0048] It should be noted here that the simplified model 1 00c1 may be removed from the full-model corrector 1 00c. 
[0049] It should also be noted that the full-model 1O0c2 includes an inverse full-model (Inverse dynamic model) and 
a direct full-model (direct dynamic model), as will be explained later. 

[0050] Specifically, the gait generator (with full-mode! correction) 100 corrects the calculated desired body position 
using the simplified model in such a way that it can satisfy the dynamic equilibrium condition more accurately than a 
gait generated merely using such a simplified model. At the same time, the generator 100 outputs a ZMP-converted 
value of full-model's corrected moment about the desired ZMP, or outputs the ZMP-converted value of full-model's 
corrected moment about the desired ZM P, while correcting the desired body position. The ZMP-converted value of full- 
model's corrected moment about the desired ZM P may be outputted as not in a ZMP-value, but as in the moment itself. 
[0051] Since the robot 1 has twelve joints as illustrated in Figure 1 , desired joint displacement commands can be 
determined solely from the inverse kinematics solution (as will be explained later) based on the given position and 
posture of the feet and the body. In other words, a desired robot posture at a current time can be Immediately determined. 
[0052] For the ease of understanding, the technique (proposed in Japanese Laid-open Patent Application No. 
2000-35201 1 ) to generate a gait freely and on a real-time basis will be explained. 

[0053] Beginning the explanation from its premise, since the generation of an Ideal desired gait can not act against 
physical laws, a demanded situation cannot be reached immediately. The transition to the demanded situation should 
be achieved slowly by changing gait parameters such as the ZMP trajectory, landing position and landing time, etc., 
within permissible ranges. In particular, assuming the dynamic system of the illustrated biped robot as a system that 
inputs the ZMP and outputs the body position, It is a kind of divergence system. Unless the gait parameter is changed 
carefully; it becomes difficult to restore to a normal state. 

[0054] Therefore, when generating a gait as desired on a real-time basis, it is preferable to predict robot's future 
behavior and to determine the gait parameters such that the robot's future behavior, e.g., a behavior at the time after 
several walking steps from now, will not diverge, and to correct the gait so as to avoid divergence if a possibility of 
occurrence of the divergence Is predicted. 

[0055] However, when a multiple-material-point model (the aforesaid full-model indicates this) as shown in Figure 6 
is used, since it needs a large volume of dynamic calculation and the system is not linear, It is quite difficult for an 
ordinary on-board CPU (mounted on the robot, I.e., the first arithmetic unit 60) to determine the gait terminal state on 
a real-time basis. 

[0056] In view of the above, in the technique proposed earlier, the system Is arranged such that a dynamic model 
that describes dynamic behavior of the robot 1 is simplified in such a way that its future behavior can analytically be 
predicted in calculation on a real-time basis. Figure 7 shows the simplified robot dynamic model. As illustrated, this 
dynamic model is a three-material-point model and is decoupled, i.e., the dynamics of the leg (foot) and those of the 
body do not interfere with each other and the dynamics of the robot as a whole Is expressed by their linear combination. 
Figure 8 is a block diagram showing dynamic calculation (conducted at a dynamic calculator in the gait generator 100) 
using the dynamic model illustrated in Figure 7. 
[0057] The dynamic model will be explained. 

1) This model comprises three material points made up of an inverted pendulum, a foot material point of the 
supporting leg and a foot material point of the free leg. 

2) The supporting leg foot material point is set at a fixed point on a coordinate system set locally at the supporting 
leg foot. The coordinate system is an XYZ rectangular coordinate system in which the origin is defined on a sole 
of the foot, projected from the center of ankle onto the sole of the foot, the X-Y plane Is equal to the sole and the 
X-axis is defined as the direction from the heel to toe. This coordinate system Is hereinafter referred to as "sup- 
porting leg local coordinate system". A coordinate system on the fixed point on the supporting leg local coordinate 
system is hereinafter referred to as "supporting leg foot material point's offset". 

Similarly, the free leg foot material point is set at a fixed point on a coordinate system that is set at the free 
leg foot. This coordinate system is hereinafter referred to as "free leg local coordinate system". A coordinate system 
on the fixed point on the free leg local coordinate system Is hereinafter referred to as "free leg foot material point's 
offset". 



8 



EP 1 398 121 A1 



A coordinate system whose origin is defined on a foot point projected from the center of ankle onto the floor 
when the supporting leg foot is entirely In contact with the floor, and whose coordinate axes are fixed on the floor 
in such a manner that the X-axis is defined as the front direction of the supporting leg foot, the Y-axis is defined 
in the left direction and the Z-axis is defined in the vertical direction, is hereinafter referred to as "supporting leg 
5 coordinate system" (that is different from the above-mentioned supporting leg local coordinate system). Unless it 

is mentioned to the contrary, the position, the velocity, the force, etc., are expressed by the supporting leg coordinate 
system. 

3) The inverted pendulum comprises a supporting point a that is freely movable in the horizontal direction, a material 
point b and a link c that connects the supporting point and the material point. The link is expansible and has no 

10 mass. It is assumed here that the link expands, when tilting, such that the height of the mass viewed from the 

supporting point is kept constant. 

The material point of the inverted pendulum corresponds to the material point of the body 24 in the sense of 
physics (the body's material point does not always indicate the center of gravity). Accordingly, the material point 
of the inverted pendulum is the same as the material point of the body. The position (more broadly, the displace- 

15 ment) of the inverted pendulum's material point is simply referred to as "inverted pendulum position". 

4) The horizontal position of the body is geometrically determined from the inverted pendulum's horizontal position. 
Specifically, it is determined such that a horizontal position (the X-Y coordinate system viewed from the supporting 
leg coordinate system) of the representative point (hereinafter referred to as "body-representing point") on a co- 
ordinate system locally set at the body (the coordinate is hereinafter referred to as "body coordinate system") 

20 becomes equal to the inverted pendulum's horizontal position. More specifically, the body-representing point and 

the inverted pendulum's material point b are determined such that they are on the same vertical line, as illustrated 
in Figure 7. A horizontal coordinate of the body- rep resenting point on the body coordinate system is referred to 
as "body material point's offset". 

25 [0058] The description of variables and parameters relating to the illustrated dynamic calculation model will then be 
explained. 

[0059] For ease of explanation, variables and parameters relating to the dynamic calculation model are defined and 
described as follows: 

[0060] The ZMP of the inverted penculum shall be present at the supporting point a, since the ZMP is defined as a 
30 point at which no moment Is generated and the supporting point is free and hence no moment Is generated there. 
Accordingly, since the inverted pendulum's supporting point can be regarded as the ZMP of the pendulum itself, it is 
referred to as "inverted pendulum's ZMP" and is, on and after, described or expressed as "ZMPpend". 
[0061] Mass and position of the individual material points are described as follows: 

■35 msup: supporting leg's material point mass 

mswg: free leg's material point mass 

mb: inverted pendulum's material point mass (body's material point mass) 
mtotal: robot mass (=mb + msup + mswg) 
mfeet: feet mass ( = msup + mswg) 
Jo xsup: supporting leg's materia! point position 

xswg: free leg's material point position 

xb: Inverted pendulum's position (body's material point position) 

[0062] On and after, xb is expressed by three-dimensional vector (XYZ coordinate system vector), if not mentioned 
45 to the contrary. The height of the inverted pendulum indicates the height from the supporting point to the material point 
and Is described as h. 

[0063] d(xb)/dt is the first order differential of xb and indicates the velocity of the inverted pendulum, whereas d2(xb) 
/dt2 is the second order differential of xb and Indicates the acceleration of the inverted pendulum. The value g Is a 
constant of the acceleration of gravity. G is a vector of the acceleration of gravity and is defined as a vector whose X, 
50 y components are zero (0) and Z component is - g. 

[0064] in the illustrated three-mate rial-point model, moment of total inertial force of the leg material point acting about 
a point of action P is defined as "leg's total inertial force moment about point P". Here, the resultant force of the Inertial 
force and gravity is hereinafter referred to "total inertial force". The coordinate (or position) of the point of action P Is 
described as xp. 

55 [0065] Eq. 1, mentioned below, is an equation strictly defining, in terms of dynamics, of the leg's total inertial force 
moment about P. 



9 



EP 1 398 121 A1 



Leg's total inertia! force moment about P = msup(xsup - xp) * G 
- msup(xsup - xp) * d2(xsup)/dt2 + mswg(xswg - xp) * G 

5 

- mswg(xswg - xp) * d2(xswg)/dt2 Eq. 1 

[0066] The feet ZMP is described as ZMPfeet and is defined by Eq. 2. The height of the feet ZMP {i.e., the Z com- 
ponent of ZMPfeet) is set to the same value as the height of the point P. Thus, the feet ZMP is a pseudo value to be 
'o corresponding to the resultant force (total inertial force) generated by the leg motion. 

Leg's total inertial force moment about P = mfeet * (ZMPfeet - xp) * G Eq.2 

is [0067] Inherently, the dynamics of the robot 1 illustrated in Figure 1 is non-linear. Therefore, by approximation, the 
relationship among the desired ZMP, the feet ZMP (ZMPfeet) and the inverted pendulum's ZMP (ZM Ppend) are defined 
by Eq. 3 as follows: 

, yQ ZMPpend = mtotal/mb * desired ZMP - mfeet/rnb * ZMPfeet Eq. 3 

[0068] Generally, the differential equation describing the behavior of a linear inverted pendulum is expressed by Eq. 4. 

,, 5 d2(xb)/dt2 , s horizontal component 

= g/h * (xb's horizontal component - ZMPpend's horizontal component) Eq. 4 

[0069] Here, the point of action P Is set to improve the accuracy of model approximation. For example, as Illustrated 
30 in a time chart of Figure 9, the point of action P is set in such a manner that it moves, at the same speed during the 
two- leg supporting period, from the origin of the supporting leg coordinate system of gait immediately before (last time 
gait) to that of the current time gait. 

[0070] The dynamic model proposed in this earlier application Is expressed by the offsets describing the relationship 
between the foot, the body and the material points illustrated in Figure 7 and the equations (Eqs. 1 to 4). This conflg- 
35 uration makes it easy to predict future behavior, as will be explained later. 

[0071] Explaining the operation of a dynamic calculator of the earlier application with reference to Figure S, it has a 
feet ZMP calculator 200. The calculator 200 calculates the feet ZMP (ZMPfeet) based on Eqs. 1 and 2 and on the point 
of action P illustrated in Figure 9. 

[0072] Then, It calculates the inverted pendulum's ZMP (ZMPpend) by multiplying the calculated ZMPfeet by mfeet/ 
40 mtotal {second coefficient), by subtracting the product from the desired ZMP, and by multiplying the difference by mtotal/ 
mb (first coefficient). In other words, the inverted pendulum's ZMP is determined or calculated by subtracting the product 
obtained by multiplying ZMPfeet (corresponding to or indicative of the feet ZMP) by the ratio between the leg's mass 
mfeet and the body material point's mass mb from the product obtained by multiplying the desired ZMP by the ratio of 
the robot mass mtotal and the body material point's mass mb. This processing corresponds to the processing of Eq. 3. 
45 [0073] The behavior of the Inverted pendulum Is expressed by Eq. 4. From this, the Inverted pendulum material 
point's horizontal position (displacement) xb is determined or calculated. 

[0074J Further, as Illustrated in Figure 8, the dynamic calculator has a body position determinator 202 which deter- 
mines the horizontal body position xb, Specifically, the determinator 202 determines the horizontal body position in 
such a way that the horizontal position of the body-representing point (illustrated in Figure 7) is equal to the horizontal 

50 position of the inverted pendulum. 

[0075] Describing the above more generally, this model (first model) is a model obtained by modeling the robot 1 by 
an inverted pendulum having at (east one material point (that may have the moment of Inertia) set at a predetermined 
position or thereabout of the leg 2, and at least one material point set at a predetermined point between the supporting 
point (that is freely movable on the floor) and the body 24, and the dynamic calculator (first model body position cal- 

55 culating means) is arranged to have the feet ZMP calculating means for calculating the feet ZMP (ZMPfeet; indicative 
of a pseudo ZMP at the feet corresponding to the resultant force of the Inertia and gravity generated by a motion of 
the leg 2) without depending on a behavior of the body 24, the ZMP corresponding value calculating means for calcu- 
lating a ZMP corresponding value of the inverted pendulum's supporting leg (ZMPpend), based on the calculated feet 
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ZMP (ZMPfeet) and the desired ZMP the Inverted pendulum's displacement calculating means for calculating the 
displacement (position) of the Inverted pendulum (xb), based on the calculated ZMP corresponding value of the inverted 
pendulum's supporting leg (ZMPpend), and the first model body position determining means for determining the model 
body position (indicative of the body position of the first model), based on the calculated displacement of the inverted 
pendulum (xb). 

[0076] And it is arranged such that the ZMP corresponding value of the inverted pendulum's supporting leg (ZMP- 
pend) is calculated by subtracting the product obtained by multiplying the feet ZMP by the second coefficient (mfeet/ 
mtotal) from the product obtained by multiplying the desired ZMP by the first coefficient (mtotal/mfeet). 
[0077] Then, explaining the gait for maintaining posture stability continuously, the dynamic model itself does merely 
calculate the body trajectory from the desired ZMP in such a manner that the dynamic equiiibrium condition at each 
instant is approximately satisfied. It can not prevent the body trajectory from diverging (it can not avoid the position of 
the body 24 from deviating from a position corresponding to the positions of the feet 22 R(L), as illustrated in Figure 10). 
[0078] it will then be discussed how the relationship between the body and the feet is appropriately retained so as 
to avoid divergence. 

[0079] For ease of understanding, the nature of the linear inverted pendulum that is especially significant forobtaining 
future body trajectory analytically will first be discussed. The explanation will be made with the use of a discrete-time- 
series model. 

[0080] Variables and parameters will be additionally defined for the inverted pendulum as follows: 

to0: natural angular frequency of inverted pendulum 
a>0 = sqrt (g/h) (here, sqrt indicate square root) 
At: sample time 

x[k]: inverted pendulum's position at k-th step (time kAt) 
v[k]: inverted pendulum's velocity at k-th step (time kAt) 

ZMPpend[k]: inverted pendulum's ZMP at k-th step (more precisely, it is assured that a signal obtained by zero- 
order holding the ZMPpend[kJ is kept inputted from time kAt to time (k+1)At. More specifically, it is assumed that 
the same signal is kept inputted to the inverted pendulum during that time of period) 

[0081 ] Further, values q[k] and p[k] are defined by Eq. 5 as follows: 

q[k] = x[k] + v[k]/toO 

p[k] - x[k] - v[k]/wO Eq. 5 

[0082] By discretizing the equation of motion of the inverted pendulum and by solving with respect to q[k] and p[k], 
we obtain Eqs. 6 and 7. In the equations, "exp" indicates an exponential function (natural logarithm). 



p(k]=exp( -G)0k At)* (p[0]+ (exp(o>0 At) — 1) ]T (exp( i©0 A t) 
*ZMPpend[i])) 

...Eq.6 

q[k]=exp(a)0kAt)*(q[0]+(exp(-co0At)- 1) £ (exp( - icoO At) 
*ZMPpend[i])) 

... Eq. 7 

[0083] The meaning or the equations will be discussed. 
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[0084] Assume that ZMPpend[l] Is set to satisfy following Eq. 8 with respect to certain definite constants ZMPmln 
and ZMPmax. 

ZMPmin < ZMPpend[i] < ZMPmax Eq. 8 

[0085] By substituting the relationship between the middle term and the right term of Eq. 8 into Eq. 6, we obtain 
following Eq. 9. 

k-1 

p[k] <exp(-co0kAt)*(pt0]+(exp(co0At)- 1) ]T (exp(icoOAt) 
* ZMPmax)) 

[0086] From the theorem of sum of geometric series, we obtain Eq, 10. 
k-i 

£ exp(icoOA t}=0 - exp(kcoO At)) / (I - exp(co0A t)) 

...Eq. 10 

[0087] Accordingly, Eq. 9 can be rewritten as Eq. 11. 

p[k] <exp( -coOkAt) * p[0]+(1 - exp( -coOkAt)) * ZMPmax Eq. 1 1 

[0088] Similarly, from the relationsh ip between the left term and the middle term of Eq. 8, Eq. 12 can be obtained. 

p[k] £ QXp(-coOkAt) * p[0]+(1 - exp( -coOkAt)) * ZMPmin Eq. 12 

[0089] Since exp(-ojOkAt) converges (gradually approaches) to zero when k becomes infinity, Eqs. 11 and 12 show 
that p[k] does not diverge and fail between ZMPmax and ZMPmin in due course, even if ZMPpend fluctuates. 
[0090] Further, as a specific example, let us discuss a case that the ZMPpend becomes a constant value ZMPO after 
lapse of a certain time. In that case, defining the time as time zero, Eq. 6 can be rewritten as Eq. 13. This indicates 
that p[k], irrespectively of its initial value, converges to ZMPO in a geometrical series manner. 

p[k]=exp(-©0kAt) * (p[0j - ZM PO)+ZMP0 Eq. 1 3 

[0091 ] More generally, it indicates that p[k], no matter what value it was at a certain time point, converges to a certain 
trajectory (that follows waveform of the ZMPpend) if the ZMPpend waveform is a same waveform. 
[0092] On the other hand, q[k] tends to diverge as will be understood from Eq. 7. 

[0093J As a specific example, let us again discuss the case that ZMPpend becomes a constant value ZMPO after 
lapse of a certain time. Defining the time as time zero, Eq. 7 can be rewritten as Eq. 1 4. This indicates that q[k] diverges 
to ZMPO in a geometric series manner, unless q[0] is ZMPO. 

q[k]=exp(o)0kAt) * (q[0] - ZMP0)4-ZMP0 Eq. 14 

[0094] Hereinafter, p[k] defined by Eq. 5 is referred to as "convergent component" and q[k] similarly defined by Eq. 
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5 Is referred to as "divergent component", 

[00951 From the above, it can be said that, in order to avoid divergence of the body trajectory and to retain an 
appropriate positionai relationship between the body and feet, the convergent component can be neglected in practice, 
and what is significant is that to control the divergent component (viewed from the supporting leg) within a range that 
5 ensures robot walking. 

[0096] More specifically, in order to avoid divergence of the body trajectory and to retain an appropriate positional 
relationship between the body and feet, it suffices if the ZMP trajectory parameters and other parameters are appro- 
priately determined such that the divergent component does not exceed the range that ensures robot walking (i.e., the 
range that prevents posture from deviating markedly). 

10 [0097] In view of the above, in the system proposed earlier, it inputs demand (demand value) concerning free leg 
foot's landing position and posture and landing time for next two walking steps, and determines the desired body 
position and posture trajectory, the desired foot position and posture trajectory and the desired ZMP trajectory. At this 
time, the gait parameters are partially corrected so as to ensure continuous walking. Hereinafter, the gaits being gen- 
erated is referred to as "current time gait", a gait succeeding thereto is referred to as "next time gait" and a gait further 

15 succeeding thereto is referred to as "next but one time gait". 

[0098] Thus, the technique proposed earlier simplified the dynamic model describing the dynamic behavior of the 
robot 1 and made possible to predict future robot behavior on a real-time basis and in an analytic manner, thereby 
enabling to generate a gait including the floor reaction force (desired ZMP) freely and on a real-time basis and to realize 
a gait of any stride, turning angle and walking period, etc., 

20 [0099] However, in the proposed technique, in order to enhance the real-time gait generation, if an excessively- 
simplified model is used, a generated gait will be far from that satisfies the dynamic equilibrium condition. In other 
words, an error or deviation of the ZMP grows. 

[0100] For that reason, the motion generation system of a legged mobile robot according to this embodiment is 
arranged such that, even when an excessively-simplified model is used, a generated (corrected) gait can correct robot 
25 motion in such a manner that the dynamic equilibrium condition is satisfied more accurately. 

[0101] It should be noted that the technique proposed in this embodiment will be applied not oniy to a case where 
a motion such as a gait is generated using the simplified model proposed earlier, but also to a case where a motion 
such as a gait is generated using a gait prepared beforehand as table values. 

[0102] Returning to the explanation of the gait generator (with full-model correction) 100 illustrated in Figures, the 
30 term "full-model" indicates a robot dynamic model that Is different from that used in determining a current time gait 
parameters. Specifically, the full-mode is preferably a robot model that is superior in the approximation accuracy to 
that used in determining the current time gait parameters. Explaining this with reference to the figures, the full-model 
should preferably be a robot dynamic model (illustrated, for example, in Figure 6) that is superior in the approximation 
accuracy to the simplified model (illustrated in Figure 7) used in determining the current time gait parameter (In the 
35 technique proposed earlier). Moreover, the full-model may be a model in which the moment of Inertia is set about each 
materia! point 

[0103] In this specification, a model used to calculate (or output) the body position based on (with the inputs of) the 
desired foot position and posture, the desired body posture and the desired ZMP, is named "direct dynamic model", 
whilst a model used to calculate (or output) the desired ZMP based on (with the inputs of) the desired foot position and 

40 posture, the desired body posture and the body position, is named "inverse dynamic model". 

[01 04] The full-model provided at the full-model corrector 1 00c is a model named "inverse dynamic full-model" (often 
referred to simply as "inverse full-mode!") or a model named "direct dynamic full-model" (often referred to simply as 
"direct full-model "). Since the direct dynamic model calculation can not be solved analytically, the body position must 
be determined with searching. The volume of the direct dynamic model calculation is usually greater than that of the 

45 inverse dynamic model calculation. 

[0105] The operation of the gait generation system of a legged mobile robot according to this embodiment, i.e., the 
gait correction will then be explained. 

[0106] Figure 11 is a flow chart (structuraiized flow chart) showing the gait generation of the gait generator (with full- 
model correction) 100. 

so [0107] The program begins at S10 in which various kinds of initialization processing are conducted. The program 
then proceeds, via S12, to S14 in which timer Interrupt at every control cycle is waited for. The control cycle (period) 
is At. The program then proceeds to S1 6 in which It is determined whether the gait is at the time of switching. When 
the result is affirmative, the program proceeds to S1 8, whilst when the result is negative, the program proceeds to S28. 
[01081 When the program proceeds to S18, the time t is initialized to zero as a current time. The program then 

55 proceeds to S20 in which a next time gait's supporting leg'coordinate system, a next but one time gait's supporting leg 
coordinate system and a current time gait period and a next time gait period are read. There values are corresponding 
to the aforesaid demand. They may be stored in the memory as a walking schedule or may be determined based on 
an instruction inputted from the joystick 44 or other operator apparatus and the history of walking up to that time. 
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[0109] i he program then proceeds to S22 In which gait parameters of the current time gait are provisionally deter- 
mined or calculated. 

[0110] As regards the parameters, the current time gait's initial free leg position and posture are determined to be 
the current free leg foot position and posture viewed from the current time gait's supporting leg coordinate system (as 

s the Initial values). The current time gait's initial supporting leg foot position and posture are determined to be the current 
supporting leg foot position and posture viewed from the current time gait's supporting leg coordinate system (as the 
initial values). The current time gait's terminal free leg foot position and postures are determined in response to the 
n ext time gait's supporting leg coordinate system viewed from the current time gait's supporting leg coordinate system. 
Specifically, they are determined in such a way that the foot position and posture of the free leg foot (obtained when 

io rotated horizontally, without slippage, from terminal position and posture in the current gait, while keeping contact with 
the floor) will shift to the next gait's supporting leg coordinate system. 

[0111] The current time gait's terminal supporting leg foot position and posture are determined to position and posture 
where the foot is in surface contact with the floor so as notto slip (those are obtained by being rotated from the current 
supporting position and posture). As a result, if the floor is fiat, the current time gait's terminal supporting leg foot 
position and posture are equal to the current time gait's supporting leg coordinate system. In the gait mentioned here, 
although the supporting leg foot is made horizontal at the gait terminal, the foot may take other position and posture. 
[0112] The ZMP trajectory parameters of the current time gait should be determined such that they are high In the 
margin of stability and do not change abruptly. The phrase "high in the margin of stability" Indicates a condition where 
ZMP is present at the center or thereabout in a minimum convex polygon (the so-called supporting polygon and is 

20 described in detail in Japanese Laid-Open Patent Application Hei 10 (1998)-86081 ). The determination of current time 
gait's ZMP trajectory parameters is provisional and they are subject to correction as will be explained later. 
[0113] The program then proceeds to S24 in which gait parameters of steady turning gait that Is to be continuous to 
the current time gait is determined. It should be noted that the "steady turning gait" indicates a periodic gait that does 
not bring about discontinuity in motion at gait boundary when the gait is repeated. 

23 [01 14] Basically, the steady turning gait comprises the first turning gait and the second turning gait. The reason why 
the term "turning" is used is that, when the rate of turning is set to zero, since this Indicates a straight advance, the 
term makes it possible to include "straight advance" in "turning" In a broad sense. The steady turning gait is generated 
by the gait generator (with full-model correction) 100 temporarily or tentatively in order to determine the divergent 
component at the current gait terminal. Therefore, the steady turning gait is not outputted from the gait generator 100. 

30 [0115] In the gait setting, boundary conditions of the leg trajectory in the gait parameters of the first turning gait and 
the second turning gait are set or determined such that the leg trajectory is made continuous in the order of the current 
time gait, the first turning gait and the second turning gait Specifically, the initial free leg foot position and posture of 
the first turning gait are set to be the terminal supporting leg foot position and posture of the current time gait viewed 
from the next time gait's coordinate system. The initial supporting leg position and posture of the first turning gait are 

3s set to be the current time gait's terminal free leg position and posture viewed from the next time gait's supporting leg 
coordinate system. 

[0116] The terminal free leg foot position and posture of the first turning gait are, similarly to the determination of the 
cu rrent time gait's terminal free leg position and posture, set or determined in response to the next but one's time gait's 
supporting leg coordinate system viewed from the next time gait's supporting leg coordinate system. The terminal 

40 supporting leg position and posture of the first turning gait are foot position and posture obtained by rotating, while 
keeping floor contact, the foot (set to the next time gait's supporting leg coordinate system) to be brought in surface 
contact with the floor so as not to slip. Therefore, if the floor surface Is fiat, the terminal supporting leg position and 
posture of the first turning gait become equaf to those in the next time gait's supporting leg coordinate system. 
[0117] The terminal free leg foot position and posture of the second turning gait are set or determined to be the same 

45 as the terminal free leg foot position and posture of the current time gait viewed from the current time gait's supporting 
leg coordinate system. The terminal supporting leg position and posture of the second turning gait are set or determined 
to be same as those of the supporting leg foot position and posture of the current time gait viewed from the current 
time gait's supporting leg coordinate system. 

[011 a] Figure 12 illustrates relationships among these gait parameters. 

so [0119] The first turning gait and the second turning gait have the same walking period as that of the next time gait. 
(The walking period should not necessarily be determined to be the same value, but should preferably be determined 
In response to the next time gait walking period.) Other movement parameters of the current time gait, the first turning 
gait and the second turning gait (Including time parameters such as two-leg supporting period's length) should be 
determined appropriately in response to the determined parameters mentioned above in such a way that they satisfy 

55 the conditions of gait (e.g., the velocity of the electric motors (actuators) are within permissible ranges.) 

[0120] The ZMP trajectory parameters of the first turning gait and the second turning gait should be set or determined 
such that they have high margin of stability and do not change abruptly. 

[0121] Aside from the above, if initial position and velocity of the body-representing position are set to values X0, 
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VO, after having generated the aforesaid first turning gait and the second turning gait with the use of the simple model 
illustrated in Figure 7, the Initial position and velocity of the body-representing position when the first turning gait gen- 
eration is again started, become equal to the set values XO, VO. The values XO, VO are hereinafter referred to as "body- 
representing point's initial position/velocity of the steady turning gait". Figure 13 shows this, In the figure, the value XO 
is illustrated as "(xO, y0)'\ and the illustration of VO is omitted. 

[0122] With this, when the first turning gait and the second turning gait are generated repeatedly using the simplified 
model illustrated in Figure 7 ( the body-representing point's initial position and velocity of the first turning gait are equal 
to the values XO, VO, unless there are accumulated calculation errors. In other words, the continuity of walking can be 
ensured. Divergent component at this time, i.e., X0+V0/o0 is hereinafter referred to as "steady turning gait's initial 
divergent component". 

[0123] Returning the explanation of Figure 11 , the program then proceeds to S26 in which this steady turning gaits 
initial divergent component is determined. Since the determination is described in detail in Japanese Patent Application 
No 2000-352011 , no further explanation will be made here. 

[0124] The program then proceeds to S28 in which the current time gait is corrected. Specifically, the current time 
gait parameters are corrected such that the current time gait's terminal divergent component becomes equal to the 
steady turning gart's initial divergent component Since the determination Is described in detail in Japanese Patent 
Application No. 2000-352011 , no further explanation will be made here, also. 

[0125] The program then proceeds to S30 in which desired (and provisional) instantaneous values of the current 
time gait are determined from the determined gait parameters. 
[0126] Figure 14 is a flow chart showing the subroutine for this. 

[0127] Explaining It, the program begins in S100 in which the desired ZMP at time (current time) t is determined 
based on the current time gait parameters, and proceeds to S102 in which the desired foot position and posture at the 
time t is determined based on the current time gait parameters. The program then proceeds to S104 in which the 
desired body posture at the time t is determined based on the current time gait parameters. 

[0128] Returning to the explanation of the flow chart of Figure 1 1 , the program proceeds to S32 in which a corrected 
gait is generated (the gait is corrected) using the full-model. Specifically, as explained with reference to Figure 5, there 
are conducted the calculation or determination of the corrected desired body position and the ZMP-converted value 
of full-model's correct moment about the desired ZMP, etc. 

[0129] The gait correction at S32 of the flow chart of Figure 11 constitutes the characteristic features of the motion 
generation of a legged mobile robot of the present invention. Variants or modifications of the features will be discussed 
in later embodiments. Therefore, the variants or modifications of the gait correction will first be outlined here. 
[0130] Figure 15 is a table showing the variations or modifications of the gait correction. The embodiment corre- 
sponding thereto is indicated by its number. 

[0131] The gait correction is grouped into methods to use the inverse dynamic full-model (inverse full-model) and 
those to use the direct dynamic full-model (direct full-model). Each group is then divided into methods not to correct 
the simplified model's ZMP (the desired ZMP inputted into the simplified model) and that to correct it. 
[0132] The group that uses the inverse dynamic full-model, but not to correct the simplified model's ZMP is divided 
into a group that uses a perturbation dynamic model for correction (hereinafter referred to as "perturbation model") 
and that does not use it. The group that uses the perturbation model is divided into a group that conducts a feedback 
(F/B) correction of the full-model and that conducts a feedforward (F/F) correction of the full-model. The other group 
that uses the i nverse dynamic full-model and that corrects the simplified model's ZMP is divided into groups in a manner 
similar to the group that does not correct the simplified model's ZMP. 

[0133] Figure 1 6 isafunctional block diagram showing the gait correction of the motion generation system according 
to the first embodiment. 

[0134] It should be noted that in all embodiments including the first embodiment (shown m Figure 1 6) but excluding 
eighth to thirteenth embodiment explained later, the gait correction must satisfy the condition expressed In the following 
equation. 

Full-model's ZMP = Desired ZMP 4- ZMP-converted value of full-model's 

corrected moment about the desired ZMP Ec J- 15 

[0135] This indicates that, on the premise that the full-model is a strict model, the gait must be corrected to strictly 
satisfy the dynamic equilibrium condition. Specifically, the full-model corrector 1 00c corrects the gait by changing the 
desired body trajectory in the desired gait comprising the desired body trajectory, the desired foot trajectory and the 
desired ZMP trajectory, or by generating the desired floor reaction force's moment about the desired ZMP (that is zero 
in the original desired gait). In the above, the term "full-model's ZMP" indicates a ZMP calculated by using the inverse 
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dynamic full-model (inverse full-model) or by causing the model to output the ZMP. In the eighth to thirteenth embod- 
iments, the gait Is corrected to almost satisfy the dynamic equilibrium condition, since the correction is conducted in a 
feedforward fashion, it can not correct the gait to strictly satisfy the condition. 

[0135] As illustrated, in the first embodiment, the simplified model's body position (the desired body position) Is 
5 calculated with the use of the desired foot position and posture, the desired body posture (not shown) and the simplified 
model. Here, the desired body position indicates the "desired body position" before having been corrected as the 
"corrected desired body position" illustrated in Figure 4. 

[0137] In the correction, specifically, the feet ZMP (ZMPfeet) at time t is calculated, from the desired foot position 
and posture at timet and preceding thereto, using Eqs. 1 and 2. Then, the inverted pendulum's ZMP (ZMPpend) is 
■o calculated using Eq. 3, the inverted pendulum's horizontal position Is then calculated from the Inverted pendulum's 
ZMP using Eq . 4, and the horizontal position of the body is next determined in such a way that It becomes equal to the 
inverted pendulum material point's horizontal position, whilst the body height Is determined using a technique of body 
height determination proposed by the applicant earfier in Japanese Laid-Open Patent Application No. Hei 10 (1998)- 
86080. 

is [0138] Next, the full-model's ZMP is calculated based on the determined body position using the inverse full-model, 
and a full-model ZMP's error is calculated from the following equation. 

Full-model ZMP's error = Full-model's ZMP - Desired ZMP Eq. 15a 

20 

[0139] The full-model ZMP's error, thus calculated, is determined or outputted as the ZMP-converted value of full- 
model's corrected moment about the desired ZMP. (In this and later embodiments, the desired body posture Inputted 
to the Inverse full-model is set to an upstanding posture, for the ease of explanation). 

[0140] Thus, the correction Is achieved in such a manner that a deviation from the dynamic equilibrium condition 
25 produced by m odeling error of the simplified mode! is canceled by the floor reaction force's moment about the desired 
ZMP, more specifically, the motion of the leg 2 to push or kick the floor is changed such that the total floor reaction 
force's moment generated cancels the deviation. 

[0141] As mentioned above, the ZMP calculated with the use of the inverse full-model Is called the full-model's ZMP. 
The body position calculation using the simplified model Is determined or outputted as the corrected desired body 
20 position, and is inputted Into a robot geometric model 1 03 illustrated in Figure 4. 

[0142] The arrangement or structure shown in Figure 1 6 can be expressed by the following two equations: 



Corrected desired body position = Simplified model' body position Eq. 1 6a 

35 

ZMP-converted value of full-model's corrected moment about desired ZMP 

= Full-model's ZMP - Desired ZMP Eq. 1 6b 

40 

[0143] Returning to the explanation of the flow chart of Figure 11, the program then proceeds to S34 In which At is 
added to the time t, and the program returns to S14 to repeat the procedures mentioned above. 
[01 44] Returning to the explanation of Figure 4 to continue the operation of the gait generation system according to 
the first embodiment, the desired body posture and the corrected desired body position (trajectory) in the instantaneous 
45 values of the desired gait generated by the gait generator (with full-model correction) 100, are forwarded to a later 
block 1 02 and are immediately inputted in the aforesaid robot geometric model (inverse kinematics solution) 1 03 there- 
in. 

[0145] The other parameters including the desired foot position and posture (trajectory), the desired ZMP (trajectory), 
the ZMP-converted value of full-model's corrected moment about the desired ZMP and the desired total floor reaction 

so farce (trajectory) are directly forwarded to a composite compliance motion determinator 104. These parameters are 
also forwarded to a desired floor reaction force distributor 1 06 where the floor reaction force is distributed to each foot 
22R, L and the desired foot floor reaction force central point and the desired foot floor reaction force are determined. 
The determined parameters are forwarded to the composite compliance motion determinator 104. 
[0146] The composite compliance motion determinator 104 forwards a corrected desired foot position and posture 

55 (with deformation compensation) to the robot geometric model 1 03. The robot geometric model 1 03 calculates, when 
inputted with the desired body position and posture (trajectory) and the corrected desired foot position and posture 
(with deformation compensation) (trajectory), joint displacement commands (command values), for the twelve joints 
including 10R, L, to satisfy them and sends the same to a joint displacement controller 10B. The joint displacement 
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controller 108 controls the displacement of the twelve joints such that they follow up the calculated joint displacement 
commands (command values). 

[0147] The actual foot floor reaction force resulting in the robot 1 is detected from the output of the six-axis force 
sensor 34 and the detected values are forwarded to the aforesaid composite compliance motion determinator 104. 
5 The actual inclination angular error resulting in the robot 1 is detected from the output of the inclination sensor 36 and 
the detected value is sent to a posture stabilization controller 112 where a compensating total floor reaction force's 
moment about the desired ZMP (desired total floor reaction force central point) Mdmd for restoring posture inclination 
is calculated. 

[0148J Further, the aforesaid ZMP-con verted value of full-model's corrected moment about the desired ZMP is con- 
fa verted into a moment at a moment converter 1 1 4 and is added to the compensating total floor reaction force's moment 
Mdmd. The resultant sum of the moments is forwarded to the composite compliance motion determinator 104. The 
determinator 1 04 generates moment corresponding thereto about the desired ZMP by correcting the desired foot po- 
sition and posture based on the inputted values. Since the ZMP-converted value of full-model's corrected moment 
about the desired ZMP is added to the compensating total floor reaction force's moment about the desired ZMP Mdmd, 
as mentioned just above, they need not always be directly inputted to the composite compliance motion determinator 
104 or the desired floor reaction force distributor 106. 

[0149] Since the arrangement or structure and operation of the composite compliance motion determinator 1 04 (il- 
lustrated in the block enclosed by dashed lines in Figure 4) are described in detail in Japanese Laid-Open Patent 
Application Hei 10 (1998)-277969 proposed by the applicant, no further explanation will be made here, 
20 [0150] Having been arranged in the foregoing manner, the system according to the first embodiment can correct the 
gait generated with the use of the simplified model proposed earlier such that the dynamic equilibrium condition is 
satisfied accurately. Further, the system can generate a motion of the gait that satisfies the dynamic equilibrium con- 
dition accurately and can control the robot 1 to follow up the generated motion, thereby enabling to improve the posture 
stabilization. 

25 [0151] Furthermore, by incorporating the free gait generation proposed in the earlier application of the applicant's 
Japanese Patent Application No. 2000-352011 into this system, it becomes possible to generate a gait (including the 
floor reaction force) that satisfies the dynamic equilibrium condition, freely and on a real-time basis, to generate a gait 
of any stride, turning angle and walking period, etc., and to generate a gait that is continuous at a boundary of adjacent 
gaits in displacement and velocity of the robot's components. 

30 [0152] It should be noted that, although the gait correction in this embodiment has an advantage that the volume of 
calculation is decreased since only the floor reaction force is manipulated, the margin of stability of the motion resulting 
in from the corrected gait is somewhat degraded when compared to the embodiments explained later. 
[0153] Figure 17 is afunctional block diagram showing the operation of the motion generation system of a legged 
mobile robot according to a second embodiment of the present invention. More specifically, it shows the gait correction 

3$ explained with reference to S32 of the flow chart of Figure 11 . 

[0154] The gait correction in the second embodiment is a method to use the inverse dynamic full-model (inverse full- 
model), a method not to correct the ZMP of the simplified model's gait, and a method to use the perturbation model. 
Further, it is a method of the full-model feedback correction and is thebaslc of full-model feedback corrections described 
in the embodiments up to a seventh embodiment. 

40 [0155] As illustrated, in the second embodiment, a feedback loop is added to the arrangement or structure of the 
first embodiment. The feedback loop inputs a value obtained by integrating (1/S; S: Laplace operator) the full-mode! 
ZMP's error and by multiplying it by an integral gain (-K that Is a value corresponding to a feedback gain) to the per- 
turbation model. And, it inputs a perturbation model's body position outputtedfrom the perturbation model to the inverse- 
full model as an additional inputted. 

45 [0156] To be more specific, the system calculates the full-model's ZMP, using the Inverse full-model, based on the 
desired foot position and posture, the desired body posture and the corrected desired body position (explained below), 
calculates an error from the desired ZMP (full-model ZMP's error), and determines (outputs) the error as the ZMP- 
converted value of full-model's corrected moment about the desired ZMP. At the same time, it Integrates the calculated 
error, multiplies the integrated value by the integral gain, and inputs the obtained product to the perturbation model as 

50 the perturbation model's ZMP such that the output of the perturbation model (perturbation model's body position) is 
added to desired body position (before correction) calculated using the simplified model to obtain the corrected desired 
body position (that is to be inputted to the inverse full-model). 

[0157] Here, different form the first embodiment, the body position (calculated with the use of the simplified model) 
is added with the perturbation model's body position (calculated with the use of the perturbation model), and the sum 
55 is determined or outputted as the corrected desired body position. 

[01 58] As illustrated in Figure 1 8, the perturbation model is a model that expresses a relationship between the desired 
ZMP's perturbation and the desired body horizontal position's perturbation under a constraint condition that the foot 
position and posture are not perturbed. More specifically, it is a model similarto the simplified model illustrated in Figure 
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7, but is modified to express the relationship between the desired ZMP's perturbation and the desired body horizontal 
position's perturbation without changing behavior of {without perturbing) the feet material points. 
[0159] In the illustrated arrangement or structure, when defining a transfer function of the Inverse full-model as 1/G 
(s) and that of the perturbation model as Gm(s), and approximating that of the simplified model as (G(s)+modeling 
5 error), the illustrated arrangement or structure can be approximated by an arrangement shown in Figure 19 and can 
be further modified as those as shown in Figures 20 and 21 . 

[01 601 Further, when the perturbation model's transfer function Gm(s) is approximated by the inversetransferfunction 
G(s) of the inverse full-model's transfer characteristic, since Gm(s)/G(s) can be deemed as 1 , the Illustrated arrange- 
ment or structure can eventually be modified as shown in Figure 22 In an approximated manner. 
10 [01 61 ] From the above, it will be understood that, In the gait correction In the second embodiment, the ZMP-converted 
value of full-model's corrected moment about the desired ZMP Is almost equal to a value obtained by filtering its mod- 
eling error by a low-cut filter (high-pass filter) whose cutoff frequency Is K/2ti [Hz] (or whose cutoff angular frequency 
is K [rad/secj) . 

[01 62J Aside from the above, to generate the full-model's corrected moment about the desired ZMP equals to correct 
is the desired ZMP to a sum of the desired ZMP and the ZMP-converted value of full-model's corrected moment about 
the desired ZMP. Since the desired ZMP must have been designed in an ideal pattern taking the margin of stability 
and some similar factors into account, the ZMP-converted value of full-model's corrected moment about the desired 
ZMP should ideally be zero. 

[01 63] In the gait correction in the second embodiment, if the absolute value K of the integral gain is sufficiently large, 
20 the ZMP-converted value of full-model's corrected moment about the desired ZMP will almost be zero and will be close 
to the ideal. 

[0164J Having been arranged in the foregoing manner, the system according to the second embodiment can have 
the same effects as those of the first embodiment and can generate a gait of high margin of stability. However, although 
the system still has the advantage that the volume of calculation Is small, since the perturbation model's body position 
25 tends to oscillate, the system is not always practical. 

[0165] Figure 23 is a functional block diagram showing the operation of the motion generation system of a legged 
mobile robot according to a third embodiment of the present invention. More specifically, It shows the gait correction 
explained with reference to S32 of the Now chart of Figure 11. 

[0166] The gait correction in the third embodiment Is a method to use the inverse dynamic full-model (Inverse full-- 
30 model), a method not to correct the ZMP of the simplified model's gait, and a method to use the perturbation model. 
Further, it is a method of the full-model feedback correction and is a general method common to the embodiments up 
to the seventh embodiment. 

[01 671 Explaining this with focus on a. difference from the foregoing embodiments, in the third embodiment, In order 
to solve the drawback of the second embodiment, I.e., in order to prevent the perturbation model oscillation, a pertur- 
bs bation model control law 23e is added to the arrangement or structure of the second embodiment in such a manner 
that a feedback control amount for controlling the perturbation model (that is an output of the control law) 23b is inputted 
to the inverse-full model as an additional input. 

[01 68] To be more specific, like the first and second embodiments, the system calculates the full-model ZMP's error, 
and outputs the error as the ZMP-converted value of full-model's corrected moment about the desired ZMP. At the 

+0 same time, it inputs various quantities of states (e.g., perturbation model's Inverted pendulum's position and velocity, 
full-model's center of gravity's position and velocity) and/or the desired gait (the desired gait parameters), and calculates 
the feedback control amount for controlling the perturbation model using the perturbation model control law. Then, it 
subtracts the calculated value from the ZM P-converted value of full-model's corrected moment about the desired ZMP 
to determine the full-model ZMP's error, integrates the determined full-model ZMP's error, multiplies the error by an 

45 integral gain (-K), adds the feedback amount for controlling the perturbation model to the product, and inputs the sum 
to the perturbation model. 

[0169] Giving a supplementary explanation to the calculation of the full-model ZMP's error, as mentioned in the 
second embodiment, since the product of the transfer functions of the perturbation model and the Inverse full-model 
is almost 1 whan the transfer function of the perturbation model is approximated by the inversetransferfunction of the 
50 transfer function of the inverse full-model, the augmentative amount due to the feedback amount for controlling the 
perturbation model added at the time of calculating the perturbation model ZMP, becomes almost equal to the feedback 
amount for controlling the perturbation model. Since the amount Is added Intentionally to prevent the perturbation model 
from oscillating, It Is not the simplified model's error. 

[01 70] In the third embodiment, therefore, taking into account the fact that the feedback amount for controlling the 
55 perturbation model is added, the equation for calculating the full-model's ZMP error is modified as follows: 

Full-model ZMP's errors Full-model's ZMP - Desired ZMP 
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— Feedback amount for controlling perturbation model Eq. 1 7 

[01 71 ] When the absolute value K of the integral gain is sufficiently great, the full-model ZMP's error becomes almost 
$ zero. Accordingly, Eq. 17 can be approximated by the next equation. 

Full-model's ZMP - Desired ZMP* 
10 Feedback amount for controlling perturbation model Eq. 1 8 

[0172J From Eqs. 15 and 18 } the following equation can be obtained: 

r5 ZMP-converted value of full-model's corrected moment about desired ZMP« 

Feedback amount for controlling perturbation model Eq. 1 9 

[0173] Therefore, when determining or calculating the ZMP-converted value of full-model's corrected moment about 
2(? the desired ZMP, instead of Eq. 15, Eq. 19 may be used. The rest of the arrangement or structure is the same as that 
of the second embodiment. 

[0174] In contrast to the second embodiment in which the ZMP-converted value of full-model's corrected moment 
about the desired ZMP is close to the ideal value (i.e., zero), in the third embodiment, disadvantageous ly, this value 
is almost equal to the feedback amount for controlling the perturbation model. For this reason, the feedback control 
25 law should be designed in such a way that the feedback amount for controlling the perturbation model becomes small 
as far as possible (ideally to zero). 

[0175] Having been arranged in the foregoing manner, the system according to the third embodiment can have the 
same effects as those of the second embodiment and can prevent the perturbation model from oscillating. 
[0176] Figure 24 is a functional block diagram showing the operation of the motion generation system of a legged 
30 mobile robot according to a fourth embodiment of the present invention. More specifically, it shows the gait correction 
explained with reference to S32 of the flow chart of Figure 11 . 

[0177] The gait corrections in the fourth embodiment to a seventh embodiment are concrete examples of the third 
embodiment. Specifically, the characteristic feature in the corrections is that there is added a control to stabilize the 
perturbation model at an upstanding position or thereabout. 
3s [0178] Explaining this with focus on a difference from the third embodiment, in the fourth embodiment, the following 
equation is used as the control law for the perturbation model: 

Feedback amount for controlling perturbation model = 

40 

Kp * Perturbation model's horizontal body position 

+Kv * Perturbation model's horizontal body velocity Eq. 20 

45 [0179] In the above, Kp and Kv are control gains. 

[0180] Specifically, the embodiment is arranged such that, thefeedback amount for controlling the perturbation model 
is calculated based on the perturbation model's horizontal body position and velocity (that are calculated by using the 
perturbation model). The rest of the arrangement or structure is the same as that of the third embodiment. 
[0181] Having been arranged in the foregoing manner, the system according to the fourth embodiment can have the 

so same effects as those of the third embodiment and can prevent the perturbation model from oscillating. However, the 
fourth embodiment has a disadvantage that an average value of the feedback amount for controlling the perturbation 
model does not become zero, although the control law is made simple. 

[0182] Figure 25 is a functional block diagram showing the operation of the motion generation system of a legged 
mobile robot according to a fifth embodiment of the present invention. More specifically, it shows the gait correction 
55 explained with reference to S32 of the flow chart of Figure 11 . 

[0183] The gait correction in the fifth embodiment is also a concrete example of the third embodiment. Likewise, the 

characteristic feature in the corrections is that there is included the control of the center of gravity. 

[0184] Explaining this with focus on a difference from the foregoing embodiments, in the fifth embodiment, the fol- 
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[owing equation is used as the control law for the perturbation modal: 



Feedback amount for controlling perturbation model - 



Kp * Center of gravity difference 



+Kv * Perturbation model's horizontal body velocity 



Eq. 21 



[01 65] In the above, The center of gravity difference is determined as follows: 



Center of gravity difference = Full-model's center of gravity position 



— Simplified model's center of gravity position 



Eq. 22 



[0186] Specifically, the embodiment is arranged such that, the feedback amount forcontrolling the perturbation model 
is calculated based on the difference of the center of gravity (obtained by subtracting the simplified model's center of 
gravity position from the full-model's center of gravity position) and the perturbation model's horizontal body velocity 
(calculated using the perturbation model). With this perturbation model control law, an average value (in time) between 
the differences of the full-model's center of gravity position and the simplified model's center of gravity position, can 
be controlled to almost zero. 

[0187] From the nature of the dynamics of the robot, the average value (in time) of the desired ZMP and that of the 
simplified model's center of gravity position are almost equal to each other. Further, the average value (in time) of the 
full-model's ZMP and that of the full-model's center of gravity position are almost equal to each other. From the above, 
the average value (in time) of the full-model's center of gravity difference and that of the full-model's ZMP are almost 
equal to each other. Furthermore, Eq. 1 8 yields the following equation: 



[0188] Accordingly, the average value (in time) of the feedback amount for controlling the perturbation model be- 
comes almost zero. In addition, from the relationship expressed in Eq. 19, an average value (in time) of the ZMP- 
converted value of the full-model's corrected moment about the desired ZMP becomes almost zero. As a result, the 
system according to the fifth embodiment can generate a gait of higher margin of stability than that generated in the 
fourth embodiment. The rest of arrangement Is the same as that of the third embodiment. 

[0189] Having been arranged in the foregoing manner, the system according to the fifth embodiment can have similar 
effects as those of the fourth embodiment and can make the average value (in time) of the ZMP-converted value of 
full-model's corrected moment about the desired ZMP almost zero. 

[0190] Figure 26 is a functional block diagram showing the operation of the motion generation system of a legged 
mobile robot according to a sixth embodiment of the present invention. More specifically, it shows the gait correction 
explained with reference to S32 of the flow chart of Figure 11 . 

[0191] The gait correction in the sixth embodiment is also a concrete example of the third embodiment. Specifically, 
the characteristic feature in the corrections is that the perturbation model's horizontal body position is controlled to 
follow up an average value (in time) of a product obtained by multiplying the output of the gain K's Integrator (26a in 
Figure 26) by rntotal/mb. 

[0192] Explaining this with focus on a difference from the foregoing embodiments, In the sixth embodiment, the 
following equation is used as the control law for the perturbation model: 



Average value (In time) of Full-model's ZMP — Average value (In time) of 



desired ZMP ~ Average value (In time) of the feedback amount for controlling 



perturbation model 



Eq. 23 



Feedback amount for controlling perturbation model = 



Kp * (Perturbation model's horizontal body position - Low-pass filter output) 
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-hKv * Perturbation model's horizontal body velocity Eq. 24 

[01 93] In the above, the low-pass filter output indicates a low-pass filtered value of - K * mtotal/mb * integrated value 
t of the full-model ZMP's error. In Figure 26, the value rntotal/rnb is the constant of the perturbation model illustrated in 
Figure 1 8. 

[0194] From perturbation model control law expressed in Eq. 24, an average value (in time) of the perturbation 
model's horizontal body position becomes almost equal to an average value of the low-pass filter output, Further, from 
the nature of the dynamics of the perturbation model, the average value (in time) of the perturbation model's horizontal 
10 body position becomes almost equal to a product obtained by multiplying the average value (in time) of the perturbation 
model's ZMP by the value mtotal/mb (indicative of the inverted pendulum's supporting point position), unless the per- 
turbation model oscillates. 

[0195] Furthermore, as will be understood from Figure 26, the average value (in time) of the low-pass filter output is 
almost equal to a difference obtained by subtracting the product obtained by multiplying the average value (in time) of 

is the perturbation model ZMP by mtotal/mb from a product obtained by multiplying the average value (in time) of the 
feedback amount for controlling the perturbation model by mtotal/mb. Accordingly, the average value (in time) of the 
feedback amount for controlling the perturbation model is almost zero. In addition, from the relationship expressed in 
Eq. 1 9, the average value (in time) of the ZMP -con verted value of full-model's corrected moment about the desired 
ZMP becomes almost zero. As a result, like the correction in the fifth embodiment, the correction according to the sixth 

20 embodiment can generate a gait of high margin of stability. The rest of arrangement is same as that of the third em- 
bodiment. 

[0196] Having been arranged in the foregoing manner, the system according to the sixth embodiment can have 
similar effects as those of the fifth embodiment 

[0197] Figure 27 is a functional block diagram showing the operation of the motion generation system of a legged 
25 mobile robot according to a seventh embodiment of the present invention. More specifically, it shows the gait correction 
explained with reference to S32 of the flow chart of Figure 11 . 

[01 98] The gait correction in the seventh embodiment is also a concrete example of the third embodiment, and is an 
intermediate or compromise method obtained by mixing the methods of the fourth to sixth embodiments. 
[0199] in the seventh embodiment, the following equation is used as the control law for the perturbation model: 

30 

Feedback amount for controlling perturbation model = 
Kp1 * Perturbation model's horizontal body position 
-s-Kp2 * Center of gravity difference 
+Kp3 * (Perturbation model's horizontal body position - Low-pass filter output) 
^ 4-Kv * Perturbation model's horizontal body velocity Eq. 25 

[020O] In the above, the low-pass filter output indicates the low-pass filtered value of - K * mtotal/mb * integrated 
value of the full-model ZMP's error. The rest of arrangement is same as that of the third embodiment. 
[0201 ] Having been arranged in the foregoing manner, the system according to the seventh embodiment can have 
45 intermediate or compromise effects as those of the fourth to sixth embodiment. 

[0202] Figure 2B is a functional block diagram showing the operation of the motion generation system of a legged 
mobile robot according to an eighth embodiment of the present invention. More specifically, it shows the gait correction 
explained with reference to S32 of the flow chart of Figure 11 . 

[0203] The gait correction in the eighth embodiment is a method to use the inverse dynamic full-model (inverse full- 
so model), a method not to correct the ZMP of the simplified model's gait, and a method to use the perturbation model. 
Further, it is the basic of similar full-model feedforward corrections in the embodiments up to a thirteenth embodiment, 
[0204] in the eighth embodiment, as illustrated, the full-model ZMP's error is determined by subtracting the desired 
ZMP (inputted to the simplified model) from the full-model's ZMP, the perturbation model's horizontal body position is 
then calculated by inputting a product (obtained by multiplying the determined error by - 1) to the perturbation model, 
55 and the corrected desired body position is then determined by adding the simplified model's body position (the desired 
body position before correction) to the calculated perturbation model's horizontal body position. 
[0205] Here, the ZMP-converted value of full-model's corrected moment about the desired ZMP is set to zero. This 
is ideal, as mentioned in the feedback type correction. Since, however the perturbation model is likely to oscillate, this 
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basic correction of the eighth embodiment Is not practical, 

[0206] As regards the body height necessary for calculating the Inverse full-model to correct the full-model, the body 
height at joint angle calculation at a preceding (last) control cycle (preceding or last program loop of the flow chart of 
Figure 11 ) may be used, Alternatively, the body height may be calculated from the first. If the perturbation model's body 
s position is not so large, either will make little difference. 

[0207] Having been arranged in the foregoing manner, the system according to the eighth embodiment can have 
the same effects as those of the second embodiment. 

[0208] Figure 29 is a functional block diagram showing the operation of the motion generation system of a legged 
mobile robot according to a ninth embodiment of the present invention. More specifically, it shows the gait correction 
10 explained with reference to S32 of the flow chart of Figure 11 . 

[0209] The gait correction in the ninth embodiment Is a method to use the inverse dynamic full-mode! (inverse full- 
model), a method not to correct the ZMP of the simplified model's gait, and a method to use the perturbation model. 
Further, it is a general method common to feedforward correction methods in the embodiments up to the thirteenth 
embodiment. 

1* [021 0] In the ninth embodiment, similarto the third embodiment, in orderto preventthe perturbation model oscillation, 
the perturbation model control law is provided and based thereon, the feedback control amount for controlling the 
perturbation model is calculated to be additionally inputted to the perturbation model. In addition, the feedback amount 
for controlling the perturbation model is determined or outputted as the ZMP-converted value of full-model's corrected 
moment about the desired ZMP. The rest of the arrangement is the same as the eighth embodiment. 

20 [021 1 ] In the ninth embodiment^ since the correction is conducted In a feedforward fashion, when the approximation 
accuracy of the perturbation model is low or when the perturbation model's horizontal body position is so large that 
the approximation accuracy is low, the approximation accuracy of the gaft corrected by the full-model will be somewhat 
degraded, since the correction amount deviates from an appropriate amount. In that case, In the feedback type cor- 
rection of the third embodiment, the approximation accuracy of the gait corrected by the full-model is less likely to drop. 

25 Nevertheless, since correction error at a certain instant will be remedied (corrected) after expiration of at least one 
control cycle in the feedforward type, the correction response In the feedforward type Is superior to that of the feedback 
type. 

[021 2] Having been arranged in the foregoing manner, the system according to the ninth embodiment can have the 
same effects as those of the third embodiment, except for that derived from the difference in the feedback type and 
30 the feedforward type. 

[0213] Figure 30 is a functional block diagram showing the operation of the motion generation system of a legged 
mobile robot according to a tenth embodiment of the present Invention. More specifically, It shows the gait correction 
explained with reference to S32 of the flow chart of Figure 11 . 

[0214] The gait correction In the tenth embodiment is a concrete example of the ninth embodiment. Specifically, the 
35 characteristic feature in the corrections is that there is included a control to stabilize the perturbation model at an 
upstanding position or thereabout. 

[0215] In the tenth embodiment, the following equation is used as the control law for the perturbation model: 

4Q Feedback amount for controlling perturbation model = 

Kp * Perturbation model's horizontal body position 

-»-Kv * Perturbation model's horizontal body velocity Eq. 26 

45 

[0216] The rest of the arrangement is the same as that of the ninth embodiment. 

[0217] Having been arranged in the foregoing manner, the system according to the tenth embodiment can have 
same effects as those of the ninth embodiment and the fourth embodiment. 

[0218] Figure 31 is a functional block diagram showing the operation of the motion generation system of a legged 
50 mobile robot according to an eleventh embodiment of the present invention. More specifically, It shows the gait cor- 
rection explained with reference to S32 of the flow chart of Figure 11 . 

[0219] The gait correction in the eleventh embodiment is also a concrete example of the ninth embodiment and like 
the fifth embodiment, the control of the center of gravity is similarly conducted. Specifically, it controls the perturbation 
model, by setting a desired settling position at a position where the center of gravity's deviation is canceled. The desired 
55 settling position is determined, for example, as follows: 

Desired settling position = -mtotal/mb * Center of gravity difference Eq, 27 
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[0220] The feedback amount for controlling the perturbation model Is calculated as follows: 

Feedback amount for controlling perturbation model = 
Kp * (Perturbation model's horizontal body position — - Desired settling 
position) + Kv * Perturbation model's horizontal body velocity + mb/mtotal * 

Perturbation model's horizontal body position Eq. 28 

[0221 J Having been arranged in the foregoing manner, the system according to the eleventh embodiment can have 
same effects as those of the ninth embodiment and the fifth embodiment. 

[0222] Figure 32 is a functional block diagram showing the operation of the motion generation system of a legged 
mobile robot according to a twelfth embodiment of the present invention. More specifically, it shows the gait correction 
explained with reference to S32 of the flow chart of Figure 11 . 

[0223] The gait correction in the twelfth embodiment is also a concrete example of the ninth embodiment. Similarly, 
in the corrections, the perturbation model's horizontal body position is controlled to follow up a product obtained by 
multiplying the average value (in time) of the ZMP error by (-1) and by the value mtotal/mb. In other words, it controls 
the perturbation model, by setting the desired settling position at a position where an averaged deviation (in time) of 
the ZMP error is canceled. 

[0224] In the twelfth embodiment, the following equation is used as the control law for the perturbation model. 

Feedback amount for controlling perturbation model = 
Kp * (Perturbation model's horizontal body position - Low-pass filter output) 
+Kv * Perturbation model's horizontal body velocity 4- mb/mtotal * 

Perturbation model's horizontal body position Eq. 29 

[0225] In the above, the low-pass filter output indicates a low-pass filtered value of — mtotal/mb * full-model ZMP's 
error. The twelfth embodiment is a feedforward modification of the sixth embodiment. 

[0226] Having been arranged in the foregoing manner, the system according to the twelfth embodiment can have 
similar effects as those of the ninth embodiment and the sixth embodiment. 

[0227] Figure 33 is a functional block diagram showing the operation of the motion generation system of a legged 
mobile robot according to a thirteenth embodiment of the present invention. Mo re specifically, it shows the gait correction 
explained with reference to S32 of the flow chart of Figure 11 . 

[0228] The gait correction in the thirteenth embodiment is also a concrete example of the ninth embodiment, and 
like the seventh embodiment, it is an intermediate or compromise method obtained by mixing the methods of the tenth 
to twelfth embodiments. 

[0229] In the thirteenth embodiment, the following equation is used as the control law for the perturbation model: 

Feedback amount for controlling perturbation model = 
Kp1 * Perturbation model's horizontal body position 
4-Kp2 * (Perturbation model's horizontal body position - (- mtotal/mb * 

Center of gravity difference) 
+Kp3 * (Perturbation model's horizontal body position - Low-pass filter 

output) 

+Kv * Perturbation model's horizontal body velocity+mtotal/mb * Perturbation 
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model's horizontal body position Eq. 30 

[0230] Similarly, the tow-pass filter output Indicates the low-pass filtered value of — mtotal/mb * full-model ZMP's 

^ error. 

[0231] Having been arranged in the foregoing manner, the system according to the thirteenth embodiment can have 
intermediate or compromise effects as those of the tenth to twelfth embodiment. 

[0232] Figure 34 is a functional block diagram showing the operation of the motion generation system of a legged 
mobile robot according to a fourteenth embodiment of the present invention. 

10 [0233] The gait correction in the fourteenth embodiment is a method to use the inverse dynamic full-model (inverse 
full-model), a method to correct the ZMP of the simplified model's gait, and a method not to use the perturbation model. 
[0234] As illustrated In Figure 34, In the fourteenth embodiment, a feedback loop Is added to the arrangement or 
structure of the first embodiment. The feedback loop additionally inputs a value obtained by integrating the full-model 
ZMP's error and by multiplying it by the integral gain (-K) to the simplified model. Further, it determines or outputs the 

is simplified model's body position as the corrected desired body position, and It also determines or outputs the full- 
model's ZMP error as the ZMP-converted value of full-model's corrected moment about the desired ZMP. 
[0235] Notably, different from the first to thirteenth embodiments, in the fourteenth embodiment, by correcting the 
desired ZMP, the simplified model's body position deviates from a desired trajectory. Accordingly, It Is preferable to 
newly determine the gait parameters. The gait parameter may be re-determlned at every controi cycle, or at a time 

20 corresponding to each breaking point of the ZMP trajectory, or at every walking step. Since the amount of correction 
of the gait parameters is decreased as the correction is made earlier, the gait parameters should preferably be corrected 
repeatedly. The gait parameters are re-determined In response to the quantity of state of the simplified model and 
some similar factors at S28 in the flow chart of Figure 11. Since, however, the gait parameter re-determination is 
described in detail in Japanese Patent Application No. 2000-352011 proposed earlier, no further explanation will be 

25 made here. 

[0236] Further, when changing the ZMP parameter in the gait parameters, it Is preferable to merely change a ZMP 
value at each ZM P breaking point, without changing a time of the breaking point. This is because a problem In sequence 
is less likely to occur and the correction is simpler. 

[0237] Further, it wiil be easy to make the amount of ZMP pattern change In a trapezoid shape. For example, an 
so appropriate one of ZMP breaking point's times after the current time, illustrated in Figure 35, may be selected as the 
trapezoid ZMP breaking point time. However, as the time approaches the gait terminal, this trapezoid ZMP breaking 
time point selection becomes difficult in the rest of period of that gait. In that case, it suffices If the ZMP correction at 
that gait Is skipped, and Is conducted at a next walking step. 

[0238] Having been arranged in the foregoing manner, the system according to the fourteenth embodiment can have 
35 same effects as those of the second embodiment and can prevent the gait from oscillating by correcting the gait pa- 
rameters. 

[0239] Figure 36 is a functional block diagram showing the operation of the motion generation system of a legged 
mobile robot according to a fifteenth embodiment of the present Invention. More specifically, It shows the gait correction 
explained with reference to S32 of the flow chart of Figure 11 . 
40 [0240] The gait correction in the fifteenth embodiment is a method to use the inverse dynamic full-model (inverse 
full-model), a method to correct the ZMP of the simplified model's gait, and a method to use the perturbation model. 
Further, it Is a general method of the full-model feedback correction. 

[0241 ] Specifically, In the fifteenth embodiment, based on the arrangement or structure of the third embodiment, the 
product obtained by multiplying the integrated full-model ZMP's error by the integral gain (-k) Is fed back, through a 

*5 distributor 36e, not only to the perturbation model, but also to the simplified model, in other words, the fifteenth em- 
bodiment is an Intermediate or a compromise correction method constituted as a mixture of the methods In the third 
embodiment and the fourteenth embodiment. Since the simplified model's behavior deviates from a desired behavior 
in this embodiment also, like the fourteenth embodiment, it is necessary to correct the gait parameters. It is alternatively 
possible to mix the methods In the fourteenth embodiment and In any of the second embodiment and the fourth to 

so seventh embodiments. 

[0242] In the fifteenth embodiment, the distributor may distribute the output at the region of frequency. Alternatively, 
It may distribute the output using a non-linear element such as a iimlter. Since the system Is a feedback system, a sum 
of the outputs from the distributor need not be equal to Its input. 

[0243] Having been arranged in the foregoing manner, the system according to the fifteenth embodiment can have 
55 same effects as those of the third and fourteenth embodiments or can have intermediate or compromise effects thereof. 
[0244] Figure 37 is a functional block diagram showing the operation of the motion generation system of a legged 
mobile robot according to a sixteenth embodiment of the present invention. More specifically, it shows the gait correction 
explained with reference to S32 of the flow chart of Figure 11 . 
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[0245j The gait correction in the sixteenth embodiment is a method to use the direct dynamic full-model (direct full- 
model), instead of the inverse dynamic full-model (inverse full-model), a method not to correct theZMP of the simplified 
model's gait. And, it is a method to control the full-model to follow up the simplified model's gait, specifically, a method 
to correctthe full-model's ZMP such that the body behavior of the full-model follows up that of the simplified model that 

5 satisfies the desired ZMP. 

[0246] More specifically as illustrated in Figure 37, in the sixteenth embodiment, the full-model's body position is 
calculated using the direct full-model, and the simplified model's body position (i.e., the desired body position before 
correction) is then subtracted therefrom to determine a difference which is then inputted a model-followup control law 
(constituted as a PID law, etc) 37b to determine the feedback amount. The determined feedback amount is then added 

"0 to the desired ZMP to determine the full-model's ZMP that is next inputted to the direct full-model to determine the full- 
model's body position, in other words, the system is arranged to have a feedback loop such that the direct full-model's 
ZMP is corrected in response to the difference between the directfull-model's body position and the simplified model's 
body position. 

[0247] As regards outputs, the system determines or outputs the feedback amount as the ZMP-con verted value of 
75 full-model's corrected moment about the desired ZMP, and determines or outputs the direct full-model's body position 
as the corrected desired body position. In the system, instead of the difference in the body positions of the direct full- 
model and the simplified model, a difference in the center of gravity positions of the models or both the difference in 
the body position and the difference in the center of gravity positions of the models may be inputted to the model- 
foilowup control law. 

20 [0248] Having been arranged in the foregoing manner, the system according to the sixteenth embodiment can have 
the same effects as those of the third embodiment, except for the disadvantage that the volume of calculation is in- 
creased. 

[0249] Figure 38 is a functional block diagram showing the operation of the motion generation system of a legged 
mobile robot according to a seventeenth embodiment of the present invention. More specifically, it shows the gait 
25 correction explained with reference to S32 of the flowchart of Figure 11. 

[0250] The gait correction in the seventeenth embodiment is a method to use the direct dynamic full-model (direct 
full-model), a method to correct the ZMP of the simplified model's gait, and a method to control the simplified model 
to follow up the full-model's gait. Specifically on the contrary to the sixteenth embodiment, it corrects the simplified 
model's ZMP such that the behavior of the simplified model follows up that of the full-model that satisfies the desired 

30 ZMP. 

[0251] More specifically, on the contrary to the sixteenth embodiment where the output of the model-followup control 
law is additionally inputted to the direct full-model, the seventeenth embodiment is arranged such that, the control law's 
output is inputted to the simplified model as an additional input. Further, the system is arranged such that it determines 
the ZMP-converted value of full-model's corrected moment about the desired ZMP zero, and it determines or outputs 

35 the direct full-model's body position as the corrected desired body position. 

[0252] When the feedback gain is high, since the simplified model's body position is almost equal to the direct full- 
model's position, the simplified model's body position may be determined or outputted as the corrected desired body 
position. Since the behavior of the simplified model deviates from its desired behavior because the model's ZMP to be 
inputted to the simplified model is corrected, similar to the fourteenth embodiment, the gait parameters must be cor- 

10 rected. 

[0253] Having been arranged in the foregoing manner, the system according to the seventeenth embodiment can 
have similar effects as that of the fourteenth embodiment, in the system, similar to the sixteenth embodiment, Instead 
of the difference in the body positions of the direct full-model and the simplified model, the difference in the centers of 
gravity position of the models or both the difference in the body position and the difference in the centers of gravity 
45 position of the models may be inputted to the model-followup control law. 

[0254] Figure 39 is a functional block diagram showing the operation of the motion generation system of a legged 
mobile robot according to an eighteenth embodiment of the present invention. More specifically, It shows the gait 
correction explained with reference to S32 of the flow chart of Figure 11. 

[0255] "he gait correction in the eighteenth embodiment is a method to use the direct dynamic full-model (direct full- 
50 model) and a method to directly determine the quantity of state of the simplified model (that corresponds to the state 
of the full-model) from the quantity of state of the full-model, 

[0256] Specifically, different from the seventeenth embodiment where the simplified model's behavior is controlled 
to follow up the full-model's behavior that satisfies the desired ZMP, the eighteenth embodiment Is arranged such that, 
the simplified model's quantity of state is directly calculated based on the assumption that the simplified model's be- 
55 haviorhas completely followed up the full-model's behavior that satisfies the desired ZMP The quantity of state of the 
simplified model is determined, specifically, by calculating the inverted pendulum's body position and velocity (of the 
simplified model) that satisfy the relationship shewn in Figure 7, relative to the body representing point's position and 
velocity of the direct full-model. Further, the system is arranged such that it determines the ZMP-converted value of 
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full-model's corrected moment about the desired ZMP zero, and It determines or outputs the direct full-model's body 
position as the corrected desired body position. 

[0257] Havin g been arranged in the foregoing manner, the system according to the eighteenth embodiment can have 
similar effects as that of the seventeenth embodiment. 
5 [0258] Figure 40 is a functional block diagram showing the operation of the motion generation system of a legged 
mobile robot according to a nineteenth embodiment of the present Invention. More specifically, it shows the gait cor- 
rection explained with reference to S32 of the flow chart of Figure 11 . 

[0259] The gait correction in the nineteenth embodiment Is a method to use the direct dynamic full-model (direct full- 
model), and a method to correct both the simplified model's ZMP and the full-model's ZMP, using a model-followup 
10 control law 1 and a model-followup control law 2, such that the behavior of the direct full-model behavior and that of 
the simplified model approach to each other. Further, the system is arranged such that it determines or outputs an 
output of the model-followup control law 2 as the ZMP-converted value of full-model's corrected moment about the 
desired ZMP and determines or outputs the full-model's body position as the corrected desired body position. 
[0260] In other words, it is an intermediate or compromise correction method constituted as a mixture of the' correc- 
ts tions of the sixteenth and seventeenth embodiments. Since the behavior of the simplified model deviates from Its 
desired behavior, similar to the fourteenth embodiment, the gait parameters should necessarily be corrected. Like the 
foregoing embodiments, the difference in the centers of gravity position of the rnodeis or both the difference in the body 
position and the difference in the centers of gravity position of the models may be inputted to the model-followup control 
law 1 and 2. 

20 [0261 ] Having been arranged in the foregoing manner, the system according to the nineteenth embodiment can have 
same effects as those of the sixteenth and seventeenth embodiments or can have intermediate or compromise effects 
thereof 

[0262] Figure 41 is a functional block diagram showing the operation of the motion generation system of a legged 
mobile robot according to a twentieth embodiment of the present invention. More specifically, it shows the gait correction 

25 explained with reference to S32 of the flow chart of Figure 11". 

[0263] The twentieth embodiment Is a modification of the first embodiment illustrated in Figure 16. The twentieth 
embodiment is arranged such that the Inverse full-model 1O0c2 comprises a combination of the inverse full-model 
100c2 and an addition point 16a illustrated in Figure 16. Different from that illustrated In Figure 16, in the twentieth 
embodiment, the inverse full-model outputs a full-model's corrected moment about the desired ZMP as a full-model's 

30 moment error, and the ZMP-converted value of full-model's corrected moment about the desired ZMP Is determined 
or calculated at a ZMP conversion block 41a. The rest of the arrangement as well as the effects of the twentieth 
embodiment Is the same as that of the first embodiment. 

[0264] Figure 42 is a functional block diagram showing the operation of the motion generation system of a legged 
mobile robot according to a twenty-first embodiment of the present invention. More specifically, it shows the gait cor- 

3s rectlon explained with reference to S32 of the flow chart of Figure 11 . 

[0265] The twenty-first embodiment is a modification of the second embodiment illustrated In Figure 1 7. Similar to 
the twentieth embodiment, the twenty-first embodiment is arranged such that the inverse full-model 100c2 comprises 
a combination of the inverse full-model 100c2 and an addition point 17a illustrated in Figure 17. Different from that 
illustrated in Figure 1 7, in the twenty-first embodiment, the inverse full-model outputs the full-model's corrected moment 

40 about the desired ZMP as thefull-model's moment error, and the ZMP-converted value of full-model's corrected moment 
about the desired ZMP is determined or calculated at a ZMP conversion block 42h. The rest of the arrangement as 
well as the effects of the twenty-first embodiment Is the same as that of the second embodiment 
[0266] Figure 43 is a functional block diagram showing the operation of the motion generation system of a legged 
mobile robot according to a twenty-second embodiment of the present invention. More specifically, it shows the gait 

45 correction explained with reference to S32 of the flow chart of Figure 11. 

[0267] The twenty-second embodiment is a modification of the sixteenth embodiment Illustrated in Figure 37. In the 
twenty-second embodiment, the model-followup control law outputs the full-model's corrected moment about the de- 
sired ZMP (the point of action of the desired floor reaction force) which is Inputted to the direct full-model. The direct 
fuil-model generates a desired movement such that the full-model's corrected moment acts about the point of action 

50 of the desired floor reaction force, and outputs the body position of the desired movement as the full-model's body 
position. The system Includes a ZMP-converslon block 43h that determines or calculates the ZMP-converted value of 
full-model's corrected moment about the desired ZMP. The rest of the arrangement as well as the effects of the twenty- 
second embodiment is the same as that of the sixteenth embodiment. 

[0268] Figure 44 is a functional block diagram showing the operation of the motion generation system of a legged 
55 mobile robot according to a twenty-third embodiment of the present invention. More specifically, it shows a gait cor- 
rection method that further corrects the corrected gait corrected by the gait correction in the foregoing embodiments 
explained with reference to S32 of the flow chart of Figure 11 . 

[0269] As illustrated In Figure 44, the twenty-third embodiment is arranged such that, it inputs the corrected desired 
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body position and the ZMP-converted value of full-model's corrected moment about the desired ZMP (obtained by any 
of the correction methods explained in the first to twenty-second embodiments) to a conversion block shown there, 
and determines its outputs as new values of the corrected desired body position and the ZMP-converted value of full- 
model's corrected moment about the desired ZMP. By inserting such a conversion block, the system in this embodiment 
5 can further decrease fluctuation of the ZMP-converted value of full-model's corrected moment about the desired ZMP, 
like a case where the moment is filtered by a low-pass filter. 

[0270] Explaining this conversion, the original value of the full-model's corrected moment about the desired ZMP (i. 
e,, the input) is inputted to a second distributor 44c that distributes the input such that the sum of two outputs (a first 
distributed output and a second distributed output) are equal to the input. Then, a product obtained by multiplying the 
10 first distributed output by ( — 1) Is added with a feedback amount for controlling a second perturbation model, and the 
sum obtained therefrom is inputted to the second perturbation model 44a. Thus, with the second perturbation model 
44a, the body position of the second perturbation model is determined in such a manner that the sum, i.e., the input 
(to the second perturbation model) becomes equal to the second perturbation model's ZMP. 

[0271] Next, the feedback amount for controlling the second perturbation model is determined by a second pertur- 
15 bation model control law 44b based on the determined second perturbation model's body position. The feedback 
amount for controlling the second perturbation model is fed back to the second perturbation mode! as mentioned above. 
At the same time, this amount is added to the second distributed output and the sum obtained therefrom is determined 
or outputted as the new value of the ZMP-converted value of full-model's corrected moment about the desired ZMP 
[0272] Further, the second perturbation model's body position is added to the original value of the corrected desired 
20 body position and the sum obtained therefrom is determined or outputted as the new value of the corrected desired 
body position. 

[0273] The second perturbation model may be the same as the model, explained in the second embodiment with 
reference to Figure 18, that expresses the relationship between the perturbation of the desired ZMP and that of the 
desired horizontal body position under the constraint condition that the foot posture and position are not perturbed. Or, 

25 it may be a model different from the above. 

[0274] In the twenty-third embodiment, the second perturbation model control law may input other quantity of state 
or gait parameters, etc. The first distributed output may be the original value of the ZMP-converted value of full-model's 
corrected moment about the desired ZMP, whilst the second distributed output may be set to zero. In other words, the 
second distributor (and its output) may be removed. In that case, when incorporating into the arrangement of the first 

30 embodiment, it will be the ninth embodiment, it is alternatively posslbleto add athird distributor or more. The conversion 
block shown in Figure 44 may be modified to multi-stage blocks connected in series. 

[0275] Further, the illustrated arrangement of the twenty-third embodiment may be inserted in parallel to any of the 
first to twenty-second embodiments. In other words, it may be arranged such that the full-model's ZMP error or that 
obtained by passing it through a control law such as an integrator is distributed by a distributor and the conversion 
35 block illustrated is connected to the distributor. For example, when incorporating it into the fourteenth embodiment 
shown in Figure 34, it will be as shown in Figure 45. The arrangement may be inserted to the foregoing embodiments 
in a combination of series and parallel connections. However, the result will be complicated in structure and the effects 
will be not so much than expected. 

[0276] Having been arranged in the foregoing manner, the system according to the twenty-third embodiment can 
■to further decrease fluctuation of the ZMP-converted value of full-model's corrected moment about the desired ZMP, like 
a case where the moment is filtered by a low-pass filter. 

[0277] The concept of the twenty-third embodiment may be extended such that some of the first to twenty-second 
embodiment are rearranged to be combined with each other in series or in parallel. 

[0278] The gait generator (with full-model correction) 1 00 illustrated in Figure 5 may be modified as shown in Figure 

45 46. 

[0279] The arrangement shown in Figure 46 is a method not to correct the ZMP of the simplified model (I.e., the gait 
correction method to bring the simplified model's ZMP to be equal to the desired ZMP), more particularly, Is a modifi- 
cation of the methods of the first to thirteenth embodiments, the sixteenth embodiment, the twentieth to twenty-second 
embodiments and the twenty-third embodiment deriving therefrom. 
50 [0280] To be more specific, since the desired gait parameters must have been generated based on the simplified 
model, In the method to bring the simplified model's ZMP to be equal to the desired ZMP, the simplified model's body 
trajectory must be the desired gait's body trajectory itself that has been generated based on the simplified model. 
Accordingly, in these methods, It becomes possible to separate the calculation of the simplified model's behavior from 
the full-model corrector. 

55 [0281] "herefore, as illustrated in Figure 46, it is arranged such that the gait parameter determinator, the desired 
instantaneous value generator and the simplified model are combined together to constitute a simplified model gait 
generator 100d such that the generator 100d generates the desired gait by calculating the simplified model's behavior, 
whereas the full-model corrector 1 00c corrects the generated desired gait to sufficiently satisfy the dynamic equilibrium 
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condition. With this, since the arrangement obtained is a mere equivalent block conversion, It can achieve the same 
effects as those of the foregoing embodiments. 

[0282J The simplified model gait generator 1 0Od may not always be such a real-time-basis gait generator as proposed 
earlier. It may be a generator that generates a gait prepared as a table data beforehand. Alternatively, it may be a 

5 generator that generates a motion other than walking such as an operation using its arms. The motion or gait generated 
by the simplified model gait generator 1 0Od maybe a set of movement pattern and floor reaction force pattern generated 
only taking static balance into account (with paying no attention to the inertia! force). In other words, it may be a set of 
movement pattern and floor points at which the center of gravity are projected. It may further be a set of movement 
pattern and the ZMP (point of action of floor reaction force) generated without taking the dynamic equilibrium condition 

10 into account. In that case, since the full-model's corrected moment about the desired ZMP becomes excessive if the 
generated gait or motion deviates far from the dynamic equilibrium condition, it is preferable to generate the gait or 
motion to satisfy the dynamic equilibrium condition as much as possible. 

[0283] It should further be noted that, in the foregoing embodiments of feedback-type, when the feedback gain such 
as the integral gain K is set to be sufficiently large, the feedback amount for controlling the perturbation model (I.e., 

is the output from the perturbation model control law) may be used as the ZMP-converted value of full-model's corrected 
moment about the desired ZMP, since, if doing so, the relationships expressed in Eqs. 15 and 17 can be satisfied and 
the full-model's correction error becomes almost zero when the feedback gain is sufficiently large. Further, when the 
ZMP-converted value of full-model's corrected moment about the desired ZMP Is sufficiently small and It does not 
influence upon the posture control, the ZMP-converted value may always be zero or the value itself may be removed. 

20 [0284J It should further be noted that the relationship expressed in Eq. 15 should be satisfied at a low frequency 
region that influences upon the posture behavior, but need not be satisfied at high frequency region unless it deviates 
excessively. Accordingly, a low-pass filter or some similar factor may be inserted in the block diagrams shown in the 
foregoing embodiments. For example, a non-linear element such as a change-rate-limitermay be added. For example, 
In the fifth, sixth and twelfth embodiments, the center of gravity difference may be passed through a non-linear element 

25 such as the change-rate-lirntter or a filter. In Eq. 21 , etc., instead of the perturbation model's horizontal body velocity, 
the change rate of the center of gravity difference may be used. In the eleventh embodiment, the desired settling 
position may be passed through a similar filter or non-linear element. 

[0285] It should further be noted that, in the foregoing embodiments, instead of the integration, other control law 
(such as PID, a filter) maybe used. In that case, the gain or filter characteristic may be varied in response to the gait 
30 parameters. 

[0286] it should further be noted thai:, although the embodiments are arranged such that the ZMP-converted value 
of full-model's corrected moment about the desired ZMP is outputted, it is alternatively possible to output the full- 
model's corrected moment immediately. 

[0287J It should further be noted that: the arrangement shown in Figure 4 may be modified such that the ZMP-con- 
35 verted value of full-model's corrected moment about the desired ZMP is added to the desired ZMP to produce a "cor- 
rected desired moment", whilst the ZMP-converted value of full-model's corrected moment about the desired ZMP is 
made zero and is inputted to the composite compliance motion determinator 1 04 (i.e., the ZMP-converted value of full- 
model's corrected moment about the desired ZMP may not not outputted from the gait generator (with full-model cor- 
rection) and may not be inputted to the composite compliance motion determinator 104). In other words, Instead of 
40 correcting by the full-model correct moment, It is alternatively possible to correct the desired ZMP. However, when 
doing so, it Is difficult to set the foot floor reaction force central point in the composite compliance control. When the 
composite compliance motion determinator 1 04, etc., (that inputs the outputs from the gait generator 100) does not 
require the information on the ftoor reaction force such as the desired ZMP, the information itself may be removed. 
[0288J It should further be noted that, although the term "(desired) ZMP" is used in the foregoing embodiments, the 
45 (desired) ZMP is an example for expressing the (desired) floor reaction force, and it is alternatively possible to express 
the force by a force and moment at a certain reference point. 

[0289] It should further be noted that, although the gait should be corrected or changed when t = 0 In S1 0 of the flow 
chart of Figure 11 , the gait may be corrected or changed at another time point. In that case, it suffices If the current 
time is deemed as the initial time of the current time gait. In other words, it suffices if the time of period of the current 
50 time gait is determined to extend from the current time to the terminal time of the current time gait. 

[02901 It should further be noted that the block diagram Illustrated In Figures 8 and 16, etc. may be altered Insofar 
as equivalent operation is possible. 

[0291] It should further be noted that, instead of correcting the body position, the body posture or the arm posture 
may be corrected if such a correction is able to vary the ZMP of the robot 1 to a great extent. It Is alternatively possible 
55 to correct the both in a composite manner. 

[0292] As mentioned above, the first embodiment is arranged to have a system for generating a motion including 
walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each connected to the body, 
comprising: desired movement determining means (the gait parameter determinator 1 00a, the desired (and provisional) 
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instantaneous value generator 1 00b, the calculation of the simplified model 1 00c1 ) for determining a desired movement 
that defines the motion; desired floor reaction force calculating means (the inverse full-model 100c2, the calculation 
of the inverse full-model shown in Figure 1 5, the addition point 16a) for calculating a desired floor reaction force based 
on a t least the determined desired movement, using a dynamic model that expresses a relationship between the move- 

5 ment of the robot and a floor reaction force; and floor reaction force controlling means (the block 102) for controlling 
the floor reaction force actually acting on the robot based on at least the calculated floor reaction force. 
[0293J Further, the embodiment is arranged to have a system for generating a motion including walking of a legged 
mobile robot 1 having at least a body 24 and a plurality of legs 2 each connected to the body, comprising: desired 
motion determining means (the gait parameter determinator 100a, the desired (and provisional) instantaneous value 

10 generator 1O0b, the calculation of the simplified model 100c1 ) for determining a desired movement and a desired ZMP 
that define the motion; desired ZMP correction amount calculating means (the inverse full-model 100c2, the calculation 
of the inverse full-model shown in Figure 1 6, the addition point 1 6a) for calculating a correction amount of the desired 
ZMP (the ZMP-converted value of full-model's corrected moment about the desired ZMP) based on at least the deter- 
mined desired movement and the desired ZMP, using a dynamic model that expresses a relationship between the 

r5 movement of the robot and a ZMP; and floor reaction force controlling means (the block 102) for controlling the floor 
reaction force actually acting on the robot based on at least the calculated correction amount of the desired ZMP. 
[0294J As mentioned above, the twentieth embodiment isarrangedto have a system for generating a motion including 
walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each connected to the body, 
comprising: desired motion determining means (the gait parameter determinator 100a, the desired (and provisional) 

20 instantaneous value generator 100b, the calculation of the simplified model 100c1 shown in Figure 41) for determining 
a desired movement and a desired a point of action of a desired floor reaction force that define the motion; desired 
floor reaction force moment calculating means (the full-model 1 00c2 (the inverse full-modal shown in Figure 41)) for 
calculating a desired floor reaction force's moment about the point of action of the desired floor reaction force based 
on at least the desired movement and the point of action of the desired floor reaction force, using a dynamic model 

25 that expresses a relationship between the movement of the robot and a floor reaction force; and floor reaction force 
controlling means (the block 1 02, the ZMP conversion block 41a shown in Figure 41)for controlling the floor reaction 
force actually acting on the robot based on at least the calculated desired floor reaction force's moment. 
[02951 As mentioned above, the second embodiment is arranged to have a system for generating an instantaneous 
value of motion including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each 

30 connected to the body, when the robot performs the motion, comprising: provisional instantaneous value determining 
means (the gait parameter determinator 100a ( the desired (and provisional) instantaneous value generator 1O0b, the 
calculation of the simplified model 100c1 shown in Figure 17) for determining provisional instantaneous values of a 
desired movement and a desired floor reaction force that constitute the motion; model floor reaction force calculating 
means (the calculation of the inverse full-model 1 00c2 shown in Figure 1 7) for calculating a model's floor reaction force 

35 (the full-model's ZMP shown in Figure 17) based on at least the determined provisional instantaneous value of the 
desired movement, using a dynamic model that expresses a relationship between the movement of the robot and a 
fioor reaction force; floor reaction force difference calculating means (the addition point 1 7a shown in Figure 17) for 
calculating a difference (the full-model ZMP's error shown in Figure 17) between the calculated model's floor reaction 
force and the determined provisional instantaneous value of the desired floor reaction force; and desired instantaneous 

40 value determining means (the gait generator (with full-model correction) 1 00, in particulartheblock 1 7b, the perturbation 
model 1 7c, the addition point 17d and to determine the output of the addition point 17d as the corrected desired body 
position) for determining a desired instantaneous value of the desired movement (the corrected desired body position 
shown in Figure 17), by correcting at least the provisional instantaneous value of the desired movement based on at 
least the calculated difference, it should be noted that this will also be applied to the third to the thirteenth embodiments. 

45 [0296] Further, the second embodiment is arranged to have a system for generating an instantaneous value of motion 
including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each connected to the 
body, when the robot performs the motion, comprising: provisional Instantaneous value determining means (the gait 
parameter determinator 100a, the desired (and provisional) instantaneous value generator 1 00b, the calculation of the 
simplified model 100c1 shown in Figure 17) for determining provisional instantaneous values of a desired movement 

so and a desired ZMP that constitute the motion; model ZMP calculating means (the calculation of the inverse full-model 
100c2 shown in Figure 17) for calculating a model's ZMP (the full-model's ZMP shown in Figure 17) based on at least 
the determined provisional instantaneous value of the desired movement, using a dynamic model that expresses a 
relationship between the movement of the robot and a ZMP; ZMP difference calculating means (the addition point 1 7a 
shown in Figure 17) for calculating a difference (the full-model ZMP's error shown in Figure 17) between the calculated 

55 model's ZMP and the determined provisional instantaneous value of the desired ZMP; and desired instantaneous value 
determining means (the gait generator (with full-model correction) 100, in particular the block 17b, the perturbation 
mode! 17c, the addition point 17d and to determine the output of the addition point 17d as the corrected desired body 
position) for determining a desired instantaneous value of the desired movement (the corrected desired body position 
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shown In Figure 17), by correcting at least the provisional instantaneous value of the desired movement based on at 
least the caicu lated difference. It should be noted that this will also be applied to the third to the thirteenth embodiments. 
[0297] As mentioned above, the twenty-first embodiment is arranged to have a system for generating an instanta- 
neous value of motion including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 
5 each connected to the body, when the robot performs the motion, comprising: provisional instantaneous value deter- 
mining means (the gait parameter determinator 100a, the desired (and provisional) instantaneous value generator 
100b, the calculation of the simplified model 100c1 shown in Figure 42) for determining provisional instantaneous 
values of a desired movement and a desired ZMP that constitute the motion; model floor reaction force moment cal- 
culating means (the calculation of the inverse full-model 1 00c2 shown In Figure 42) for calculating a model floor reaction 

10 force's moment about the provisional instantaneous value of the desired ZMP (the full-model's corrected moment about 
the desired ZMP) based on at least the determined provisional Instantaneous values of the desired movement and the 
desired ZMP, using a dynamic model that expresses a relationship between the movement of the robot and a floor 
reaction force; and desired instantaneous value determining means (the gait generator (with full-model correction) 100, 
in particular the perturbation model 42b, the block 42d, the addition point 42g and to determine the output of the addition 

1$ point 42g as the corrected desired body position) for determining a desired Instantaneous value of the desired move- 
ment (the corrected desired body position shown In Figure 42), by correcting at least the provisional instantaneous 
value of the desired movement based on at least the calculated model floor reaction force's moment. 
[0298] As mentioned above, the second embodiment is arranged to have a system for generating an instantaneous 
value of motion including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each 

20 connected to the body, when the robot performs the motion, comprising: provisional Instantaneous value determining 
means (the gait parameter determinator 100a, the desired (and provisional) instantaneous value generator 100b, the 
calculation of the simplified model 100c1 shown in Figure 17) for determining provisional instantaneous values of a 
desired movement and a desired floor reaction force that constitute the motion; model floor reaction force calculating 
means (the calculation of the inverse full-model 1 00c2 shown In Figure 1 7) for calculating a model's floor reaction force 

25 (the full-model's ZMP shown in Figure 17) based on at least the determined provisional instantaneous value of the 
desired movement, using a dynamic model that expresses a relationship between the movement of the robot and a 
floor reaction force; floor reaction force difference calculating means (the addition point 1 7a shown In Figure 17) for 
calculating a difference (the full-model ZMP's error shown in Figure 17) between the calculated model's floor reaction 
force and the determined provisional instantaneous value of the desired floor reaction force; and desired instantaneous 

30 value determining means (the gait generator (with full-model correction) 1 00, in particularthe block 1 7b, the perturbation 
model 17c, the addition point 17d, to determine the output of the addition point 17d as the corrected desired body 
position and to determine the output of the addition point 17a as the ZMP-converted value of full-model's corrected 
moment about the desired ZM P) for determining desired instantaneous values of the desired movement and th e desired 
floor reaction force (the corrected desired body position andthe ZMP-converted value of full-model's corrected moment 

35 about the desired ZMP, etc., shown in Figure 17), by correcting at least the provisional instantaneous value of the 
desired movement based on at least the calculated difference such that the relationship between the movement and 
the floor reaction force is satisfied. It should be noted that this will also be applied to the third to the thirteenth embod- 
iments. 

[0299] The second embodiment is also arranged to have a system for generating an Instantaneous value of motion 

40 including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each connected to the 
body, when the robot performs the motion, comprising: provisional instantaneous value determining means (the gait 
parameter determinator 1 00a, the desired (and provisional) Instantaneous value generator 1 00b, the calculation of the 
simplified model 1 00c1 shown in Figure 17) for determining provisional instantaneous values of a desired movement 
and a desired ZMP that constitute the motion; model ZMP calculating means (the calculation of the inverse full-model 

45 1 00c2 shown in Figure 17) for calculating a model's ZMP (the full-model's ZMP shown in Figure 17) based on at least 
the determined provisional instantaneous value of the desired movement, using a dynamic model that expresses a 
relationship between the movement of the robot and a ZMP; ZMP difference calculating means (the addition point 1 7a 
shown In Figure 17) for calculating a difference (the full -model ZMP's error shown In Figure 17) between the calculated 
model's ZM P and the determined provisional instantaneous value of the desired ZMP; and desired instantaneous value 

50 determining means (the gait generator (with full-model correction) 100, in particular the block 17b, the perturbation 
model 17c, the addition point 17d, to determine the output of the addition point 17d as the corrected desired body 
position and to determine the output of the addition point 17a as the ZMP-converted value of full-model's corrected 
moment about the desired ZM P) for determining desired Instantaneous values of the desired movement and the desired 
floor reaction force (the corrected desired body position and the ZMP-converted value of full-model's corrected moment 

55 about the desired ZMP, etc. , shown in Figure 1 7) such that the relationship between the movement and the floor reaction 
force is satisfied, by correcting at least the provisional instantaneous value of the desired movement based on at least 
the calculated difference. It should be noted that this will also be applied to the third to the thirteenth embodiments. 
[0300] As mentioned above, the twenty-first embodiment is arranged to have a system for generating an instanta- 
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neous value of motion Including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 
each connected to the body, when the robot performs the motion, comprising: provisional Instantaneous vafue deter- 
mining means (the gait parameter determinate r 100a, the desired (and provisional) instantaneous value generator 
100b, the calculation of the simplified model 100c1 shown in Figure 42) for determining provisional instantaneous 

5 values of a desired movement and a desired ZMP that constitutes the motion; model floor reaction force moment 
calculating means (the calculation of the inverse full-model 100c2 shown in Figure 42) for calculating a model floor 
reaction force's moment about the provisional instantaneous value of the desired ZMP (the full-model's corrected mo- 
ment about the desired ZMP shown in Figure 42) based on at least the determined provisional instantaneous values 
of the desired movement and the desired ZMP, using a dynamic model that expresses a relationship between the 

10 movement of the robot and a floor reaction force; and desired instantaneous value determining means (the gait gen- 
erator (with full-model correction) 1 00, in particular the perturbation model 42b, the block 42d f the addition point 42g, 
the block 42h, to determine the output of the addition point 42g as the corrected desired body position and to determine 
the output of the block 42h as the ZMP-converted vaiue of full-model's corrected moment about the desired ZMP (the 
point of action of desired floor reaction force)) for determining a desired instantaneous values of the desired movement 

15 and the desired floor reaction force (the corrected desired body position and the ZMP-converted value of full-model's 
corrected moment about the desired ZMP, etc., shown in Figure 42), by correcting at leastthe provisional instantaneous 
value of the desired movement based on at least the calculated model floor reaction force's moment such that the 
relationship between the movement and the floor reaction force is satisfied. 

[0301 J As mentioned above, the second embodiment is arranged to have a system for generating an instantaneous 

20 value of motion including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each 
connected to the body, when the robot performs the motion, comprising; provisional instantaneous vaiue determining 
means (the gait parameter determinant 100a, the desired (and provisional) instantaneous value generator 100b, the 
calculation of the simplified model 1 0Oc1 shown in Figure 1 7) for determining provisional instantaneous values of a 
desired movement and a desired floor reaction force that constitute the motion; model output calculating means (the 

25 calculation of the inverse full-model 100c2 shown in Figure 1 7) for inputting at leastthe determined provisional instan- 
taneous value of the desired movement to a dynamic model that expresses a relationship between the movement of 
the robot and a floor reaction force, and for calculating an output of the model (the full-model's ZMP shown in Figure 
17); floor reaction force difference calculating means (the addition point 17a and its output shown in Figure 17) for 
calculating a difference (the full-model ZMP's error shown in Figure 17) between the calculated output of the model 

30 and the determined provisional instantaneous value of the desired floor reaction force; desired movement correction 
amount calculating means (the perturbation model 1 7c and the block 1 7b shown in Figure 1 7) for calculating a correction 
amount of at least the desired movement (the perturbation model's body position shown in Figure 1 7) based on at least 
the calculated difference; model input correcting means (the addition point 17d shown in Figure 17) for additionally 
inputting the calculated correction amount to the dynamic model; and desired instantaneous value determining means 

^5 (the gait generator (with fuii-model correction) 100, in particular to determine the output of the addition point 17d as 
the corrected desired body position and to determine the output of the addition point 1 7a as the ZMP-converted value 
of full-model's corrected moment about the desired ZMP) for determining desired instantaneous values of the desired 
movement and the desired floor reaction force based on at least the input to and the output from the dynamic model. 
It should be noted that this will also be applied to the third to the seventh embodiments. 

40 [0302] The second embodiment is also arranged to have a system for generating an instantaneous value of motion 
including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each connected to the 
body, when the robot performs the motion, comprising: provisional Instantaneous value determining means (the gait 
parameter determinator 100a, the desired (and provisional) instantaneous value generator 1 00b, the calculation of the 
simplified model 100c1 shown in Figure 17) for determining provisional instantaneous values of a desired movement 

is and a desired ZMP that constitute the motion; model output calculating means (the calculation of the inverse full-model 
1 00c2 shown in Figure 1 7) for inputting at leastthe determined provisional Instantaneous value of the desired movement 
to a dynamic model that expresses a relationship between the movement of the robot and a ZMP, and for calculating 
an output of the model (the full-model's 2IMP shown in Figure 1 7); ZMP difference calculating means (the addition point 
17a and its output shown in Figure 17) for calculating a difference (the full-model ZMP's error shown in Figure 17) 

50 between the calculated output of the model and the determined provisional instantaneous value of the desired ZMP; 
desired movement correction amount calculating means (the perturbation model 1 7c and the block 1 7b shown in Figure 
1 7) for calculating a correction amount of at least the desired movement (the perturbation model's body position shown 
in Figure 1 7) based on at least the calculated difference; model Input correcting means (the addition point 1 7d shown 
in Figure 1 7) for additionally inputting the calculated correction amount to the dynamic model; and desired instantane- 

55 ous value determining means (the gait generator (with full-model correction) 1 00, in particular to determine the output 
of the addition poin: 1 7d as the corrected desired body position and to determine the output of the addition point 1 7a 
as the ZMP-converted value of full-model's corrected moment about the desired ZMP) for determining desired Instan- 
taneous values of the desired movement and the desired floor reaction force based on at least the input to and the 
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output from the dynamic model. It should be noted that this will also be applied to the third to the seventh embodiments. 
[0303] As mentioned above, the twenty-first embodiment Is arranged to have a system for generating an Instanta- 
neous value of motion including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 
each connected to the body, when the robot performs the motion, comprising: provisional instantaneous value deter- 

5 mining means (the gait parameter determinator 100a, the desired (and provisional) Instantaneous value generator 
100b, the calculation of the simplified model 10Oc1 shown in Figure 42) for determining provisional Instantaneous 
values of a desired movement and a desired ZMP that constitute the motion; model output calculating means (the 
calculation of the inverse full-mode! 1 00c2 shown in Figure 42) for inputting at least the determined provisional instan- 
taneous values of the desired movement and the desired ZMP to a dynamic model that expresses a relationship 

io between the movement of the robot and a floor reaction force's moment about a point of action of a floor reaction force, 
and for calculating an output of the model as a floor reaction force's moment about the provisional instantaneous value 
of the desired ZMP (the full-model's corrected moment about the desired ZMP shown in Figure 42); desired movement 
correction amount calculating means (the perturbation model 42b and the block 42d shown in Figure 42) for calculating 
a correction amount of at least the desired movement (the perturbation model's body position shown in Figure 42) 

is based on at least the output of the model; model input correcting means (the addition point 42g shown in Figure 42) 
for additionally Inputting the calculated correction amount to the dynamic model; and desired instantaneous value 
determining means (the gait generator (with full-model correction) 100, in particular the block 42h, to determine the 
output of the addition point 42g as the corrected desired body position and to determine the output of the block 42h 
as the ZMP-converted value of full-model's corrected moment about the desired ZMP (the point of action of desired 

20 floor reaction force)) for determining desired instantaneous values of the desired movement and the desired floor 
reaction force based on at least the input to and the output from the dynamic model. 

[0304) As mentioned above, the third embodiment is arranged such that, in addition to the arrangement of the second 
embodiment, the desired movement correction amount calculating means includes: a perturbation model (the pertur- 
bation model 23b shown In Figure 23) that expresses a dynamic relationship between perturbation of the floor reaction 

25 force and perturbation of the movement of the robot; first feedback amount calculating means (the perturbation model 
control law 23e) for calculating a first feedback amount (the feedback amount for controlling the perturbation model 
shown in Figure 23) based on at least one of a quantity of state of the perturbation model (e.g., the perturbation model's 
body position and/or velocity) and a quantity of state of the dynamic model (e.g., the dynamic model's center of gravity 
position); and second feedback amount calculating means (the addition point 23c and the block 23d shown in Figure 

30 23) for calculating a second feedback amount based on at least a difference between the calculated difference and 
the first feedback amount; and calculates the correction amount of the desired movement by inputting a sum of the 
first and second feedback amounts to the perturbation model (the addition point 23f and the perturbation model 23b 
shown in Figure 23). 

[0305] The fifth embodiment and the seventh embodiment are arranged such that, the first feedback amount caicu- 

35 lating means calculates the first feedback amount based on at least the dynamic model's center of gravity position. 16. 
[0306] As mentioned above, the eighth embodiment is arranged to have a system for generating an instantaneous 
value of motion including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each 
connected to the body, when the robot performs the motion, comprising: provisional instantaneous value determining 
means (the gait parameter determinator 100a, the desired (and provisional) instantaneous value generator 100b, the 

40 calculation of the simplified model 100c1 shown in Figure 28) for determining provisional instantaneous values of a 
desired movement and a desired floor reaction force that constitute the motion; model output calculating means (the 
calculation of the Inverse fufl-model 100c2 shown In Figure 28) for Inputting at least the determined provisional instan- 
taneous value of the desired movement to a dynamic model that expresses a relationship between the movement of 
the robot and a floor reaction force, and for calculating an output of the model (the full-model's ZMP shown in Figure 

45 28); floor reaction force difference calculating means (the addition point 28a shown In Figure 28) for calculating a 
difference (the full-model ZMP's error shown In Figure 28) between the calculated output of the model and the deter- 
mined provisional instantaneous value of the desired floor reaction force; desired movement correction amount calcu- 
lating means (the block 28b and the perturbation model 28c shown In Figure 28) for calculating a correction amount 
of at least the desired movement (the perturbation model's body position shown in Figure 28) based on at least the 

50 calculated difference; and desired instantaneous value determining means (the gait generator (with full-model correc- 
tion) 100, in particular the addition point 28d, to determine the output of the addition point 28d as the desired corrected 
body position and to determine the ZMP-converted value of full-model's corrected moment about the desired ZM P to 
zero) for determining desired Instantaneous values of the desired movement and the desired floor reaction force based 
on at least the calculated correction amount. It should be noted that this will also be applied to the ninth to thethirteenth 

55 embodiments. 

[0307] The eighth embodiment is also arranged to have a system for generating an instantaneous value of motion 
Including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each connected to the 
body, when the robot performs the motion, comprising: provisional instantaneous value determining means (the gait 
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parameter determinates 100a, the desired (and provisional) Instantaneous value generator 1O0b, the calculation of the 
simplified model 100c1 shown in Figure 28) for determining provisional instantaneous values of a desired movement 
and a desired ZMP that constitute the motion; model output calculating means (the calculation of the inverse full-model 
100c2 shown in Figure 28) for inputting at leastthe determined provisional instantaneous value of the desired movement 

5 to adynamic model that expresses a relationship between the movement of the robot and a ZMP, and for calculating 
an output of the model (the full-model's ZMP shown in Figure 28); ZMP difference calculating means (the addition point 
28a shown in Figure 28) for calculating a difference (the full-model ZMP's error shown in Figure 28) between the 
calculated output of the model and the determined provisional instantaneous value of the desired ZMP; desired move- 
ment correction amount calculating means (the block 28b and the perturbation model 28c shown in Figure 28) for 

to calculating a correction amount of at least the desired movement (the perturbation model's body position shown in 
Figure 28) based on at least the calculated difference; and desired instantaneous value determining means (the gait 
generator (with full-model correction) 1 00, in particular the addition point 28d, to determine the output of the addition 
point 28d as the corrected desired body position and to determine the ZMP-converted value of full-model's corrected 
moment about the desired ZMP to zero) for determining desired instantaneous values of the desired movement and 

15 the desired floor reaction force based on at least the calculated correction amount. It should be noted that this will also 
be applied to the ninth to the thirteenth embodiments. 

[0308] The eighth embodiment is further arranged to have a system for generating an instantaneous value of motion 
including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each connected to the 
body, when the robot performs the motion, comprising: provisional instantaneous value determining means (the gait 

Jo parameter determinator 100a, thedesiired (and provisional) instantaneous value generator 1O0b, the calculation of the 
simplified model 10Oc1 shown in Figure 28) for determining provisional instantaneous values of a desired movement 
and a desired ZMP that constitute the motion; model output calculating means (the calculation of the inverse full-model 
1 00c2, the addition point 28a shown In Figure 28) for inputting at least the determined provisional instantaneous value 
0 f the desired movement to a dynamic model that expresses a relationship between the movement of the robot and a 

25 floor reaction force's moment about a point of action of the floor reaction, and for calculating an output of the model 
as a floor reaction force's moment about the provisional instantaneous value of the desired ZMP (the full-model ZMP's 
error shown in Figure 28); desired movement correction amount calculating means (the block 28b and the perturbation 
model 28c shown in Figure 28) for calculating a correction amount of at least the desired movement (the perturbation 
model's body position shown in Figure 28) based on at leastthe output of the model; and desired Instantaneous value 

30 determining means (the gait generator (with full-model correction) 100, In particularthe addition point 28d, to determine 
the output of the addition point 28d as the corrected desired body position and to determine the ZMP-converted value 
of full-model's corrected moment about the desired ZMP to zero) for determining desired instantaneous values of the 
desired movement and the desired floor reaction force based on at least the calculated correction amount. It should 
be noted that this will also be applied to the ninth to the thirteenth embodiments. 

35 [0309J The ninth embodiment is arranged such that, in addition to the arrangement of the eighth embodiment, the 
desired movement correction amount calculating means includes: a perturbation model (the perturbation model shown 
in Figure 29) that expresses a dynamic relationship between perturbation of the floor reaction force and perturbation 
of the movement of the robot; feedback amount calculating means (the perturbation model control law 29e shown in 
Figure 29) for calculating a feedback amount (the feedback amount for controlling the perturbation model shown in 

JO Figure 29) based on at least one of a quantity of state of the perturbation model (e.g., the perturbation model's body 
position and/or velocity) and a quantity of state of the dynamic model (e.g., the dynamic model's center of gravity 
position); and feedforward amount calculating means (the block 29b shown in Figure 29) for calculating a feedforward 
amount such that the calculated difference or an output of the dynamic model is canceled; and calculates the correction 
amount of the desired movement by inputting a sum of the feedback amount and the feedforward amount to the per- 

45 turbation model (the addition point 29c and the perturbation model shown in Figure 29). 

[0310] The eleventh and the thirteenth embodiments are arranged such that, the first feedback amount calculating 
means calculates the first feedback amount based on at least a position of the dynamic model's center of gravity (the 
full-model's center of gravity position shown in Figure 31 or 33). 

[0311] As mentioned above, thefourteenth embodiment is arranged to have a system for generating an instantaneous 
50 value of motion including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each 
connected to the body, when the robot performs the motion, comprising: desired floor reaction force provisional instan- 
taneous value determining means (the gait parameter determinator 1 00a, the desired (and provisional) instantaneous 
value generator 1 00b) for determining a provisional instantaneous value of at least a desired floor reaction force (the 
desired ZMP shown in Figure 34) in a desired movement and the desired floor reaction force that constitute the motion; 
55 desired movement provisional instantaneous value calculating means (the calculation of the simplified model 100c1 
shown in Figure 34) for inputting at least the determined provisional instantaneous value of the desired floor reaction 
force to a first dynamic model that expresses a relationship between the movement of the robot and a floor reaction 
force, and for calculating a provisional instantaneous value of the desired movement (the simplified model's body 
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position shown In Figure 34); second model output calculating means (the calculation of the Inverse full-model 100c2 
shown in Figure 34) for Inputting at least the determined provisional instantaneous value of the desired movement to 
a second dynamic model that expresses the relationship between the movement of the robot and the fioor reaction 
force, and for calculating an output of the second dynamic model (the full-model's ZMP shown in Figure 34); floor 

5 reaction force difference calculating means (the addition point 34a shown in Figure 34) for calculating a difference (the 
full-model ZMPs error shown in Figure 34) between the calculated output of the second dynamic model and the de- 
termined provisional instantaneous value of the desired floor reaction force; desired floor reaction force correction 
amount calculating means (the block 34b shown in Figure 34) for calculating a correction amount of at least the desired 
floor reaction force (the simplified model's ZMP correction amountshown in Figurer 34) based on at least the calculated 

to difference; model input correcting means (the addition point 34c shown In Figure 34) for additionally inputting the 
calculated correction amount to the first dynamic model; and desired Instantaneous value determining means (the gait 
generator (with full-model correction) 100, in particular to determine the simplified model's body position shown In 
Figure 34 as the corrected desired body position and to determine the output of the addition point 34a as the ZMP- 
converted value of full-model's corrected moment about the desired ZMP) fordetermining desired Instantaneous values 
of the desired movement and the desired floor reaction force (the corrected desired body position and the ZMP-con- 
verted value of full-model's corrected moment about the desired ZMP shown in Figure 34) based on at least the Input 
to and output from the second dynamic model. 

[031 2] The fourteenth embodiment is also arranged to have a system for generating an Instantaneous value of motion 
including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each connected to the 

20 body, when the robot performs the motion, comprising: desired ZMP provisional instantaneous value determining 
means (the gait parameter determlnator 1 00a, the desired (and provisional) instantaneous value generator 100b) for 
determining a provisional instantaneous value of at least a desired ZMP (the desired ZMP shown in Figure 34) In a 
desired movement and the desired ZMP that constitute the motion; desired movement provisional instantaneous value 
calculating means (the calculation of the simplified model 1 00c1 shown In Figure 34) for Inputting at least the determined 

25 provisional instantaneous value of the desired ZMP to a first dynamic model that expresses a relationship between 
the movement of the robot and a ZMP, and for calculating a provisional instantaneous value of the desired movement 
(the simplified model's body position shown in Figure 34); second model output calculating means (the calculation of 
the inverse full-model 1 00c2 shown In Figure 34) for Inputting at least the determined provisional instantaneous value 
of the desired movement to a second dynamic model that expresses a relationship between the movement of the robot 

30 and the ZMP, and for calculating an output of the second dynamic model (the full-model's ZMP shown in Figure 34); 
ZMP difference calculating means (the addition point 34a shown in Figure 34) for calculating a difference (the full- 
model ZMP's e rror shown In Figure 34) between the calculated output of the second dynamic model and the determined 
provisional instantaneous value of the desired ZM P; desired ZMP correction amount calculating means (the block 34b 
shown in Figure 34) for calculating a correction amount of at least the desired ZMP (the simplified model's ZMP cor- 

35 recti on amount shown in Figurer 34) based on at least the calculated difference; model Input correcting means (the 
addition point 34c shown in Figure 34) for additionally inputting the calculated correction amount to the first dynamic 
model; and desired instantaneous value determining means (the gait generator (with full-model correction) 100, in 
particular to determine the simplified model's body position shown in Figure 34 as the corrected desired body position 
and to determine the output of the addition point 34a as the ZMP-converted value of full-model's corrected moment 

40 about the desired ZMP) for determining desired instantaneous values of the desired movement and the desired floor 
reaction force (the corrected desired body position and the ZMP-converted value of full-model's corrected moment 
about the desired ZMP shown in Figure 34) based on at least the Input to and output from the second dynamic model. 
[0313] The fourteenth embodiment is further arranged to have a system for generating an instantaneous value of 
motion including walking of a (egged mobile robot 1 having at least a body 24 and a plurality of legs 2 each connected 

45 to the body, when the robot performs the motion, comprising: desired ZMP provisional instantaneous value determining 
means (the gait parameter determlnator 1 00a, the desired (and provisional) instantaneous value generator 100b) for 
determining a provisional Instantaneous value of at least a desired ZMP (the desired ZMP shown in Figure 34) In a 
desired movement and the desired ZM P that constitute the motion; desired movement provisional Instantaneous value 
calculating means (the calculation of the simplified model 1 0Oc1 shown in Figure 34) for inputting at least the determined 

50 provisional instantaneous value of the desired ZMP to a first dynamic model that expresses a relationship between 
the movement of the robot and a ZMP, and for calculating a provisional Instantaneous value of the desired movement 
(the simplified model's body position shown in Figure 34); second model output calculating means (the calculation of 
the Inverse full-model 1 00c2 and the addition point 34a shown in Figure 34) for Inputting at least the calculated provi- 
sional instantaneous value of the desired movement and the determined provisional instantaneous value of the desired 

55 ZMP to a second dynamic model that expresses a relationship between the movement of the robot and a floor reaction 
force's moment about a point of action of the floor reaction force, and for calcuiating an output of the second dynamic 
model as a floor reaction force's moment about the Instantaneous value of the desired ZMP (the full-model's ZMP 
shown in Figure 34); desired ZMP correction amount calculating means (the block 34b shown in Figure 34) for calcu- 
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lating a correction amount of at least the desired ZMP (the simplified model's ZMP correction amount shown in Rgurer 
34) based on at least the calculated output of the second dynamic model; model Input correcting means (the addition 
point 34c shown in Figure 34) for additionally inputting the calculated correction amount to the first dynamic model; 
and desired instantaneous value determining means (the gait generator (with full-model correction) 1 00, in particular 

5 t 0 determine the simplified model's body position shown in Figure 34 as the corrected desired body position and to 
determine the output of the addition point 34a as the ZM P-converted value of full-model's corrected moment about the 
desired ZMP) for determining desired instantaneous values of the desired movement and the desired ZMP (the cor- 
rected desired body position and the ZM P-converted value of full-model's corrected moment about the desired ZMP 
shown in Figure 34)based on at least the input to and output from the second dynamic model. 

ro The fifteenth embodiment is arranged such that, in addition to the arrangement of the fourteenth embodiment, it further 
includes: desired movement correction amount calculating means (the perturbation model control law 36b, the addition 
point 36c, the block 36d, the distributor 36e, the addition point 36f, the perturbation model 36g shown in Figure 36) for 
calculating a correction amount of at least the desired movement (the perturbation model's body position shown in 
Figure 36) based on at least the calculated difference; and second model Input correcting means (the addition point 

t5 36h shown in Figure 36) for additionally inputting the calculated correction amount of the desired movement to the 
second dynamic model. 

[0314J Further, it is arranged such that, the desired movement correction amount calculating means includes: a 
perturbation model (the perturbation mode! 36g shown in Figure 36) that expresses a dynamic relationship between 
perturbation of the floor reaction force and perturbation of the movement of the robot; first feedback amount calculating 
zo means (the pertu rbation model control law 36b shown in Figure 36) for calculating a first feedback amount (thefeedback 
amount for controlling the perturbation model shown) based on at least one of a quantity of state of the perturbation 
model (e.g., the perturbation model's body position and/or velocity) and a quantity of state of the dynamic model (e. 
g., the dynamic model's center of gravity position); and second feedback amount calculating means (the addition point 
36c, the integrator 36d and the distributor 36e shown in Figure 36) for calculating a second feedback amount (pertur- 
bs bation model's ZMP correction amount shown in Figure 36) based on at least a difference between the calculated 
difference (or the output of the model) and the first feedback amount; and calculates the correction amount of the 
desired movement by inputting a sum of the first and second feedback amounts to the perturbation model (the addition 
point 36f and the perturbation model 36g shown in Figure 36). 

[0315] The sixteenth embodiment Is arranged to have a system for generating an instantaneous value of motion 

so including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each connected to the 
body, when the robot performs the motion, comprising: provisional instantaneous value determining means (the gait 
parameter determinator 100a and the desired (and provisional) instantaneous value generator 100b shown in Figure 
5, the calculation of the simplified model 1 00c1 shown In Figure 37) for determining provisional instantaneous values 
of a desired movement and a desired floor reaction force that constitute the motion; model movement instantaneous 

35 value calculating means (the calculation of the direct full-model 100c2 shown in Figure 37) for inputting the determined 
provisional instantaneous value of the desired floor reaction force to a dynamic model that expresses a relationship 
between the movement of the robot and af loor reaction force, and for calculating an instantaneous value of the dynamic 
model's movement; model movement difference calculating means (the addition point 37a shown in Figure 37) for 
calculating a difference between the Instantaneous value of the dynamic model's movement and the determined pro- 

40 visional instantaneous value of the desired movement; correction amount calculating means (the model-followup feed- 
back control law 37b shown in Figure 37) for calculating a correction amount based on the difference such that the 
difference approaches zero; model input correcting means (the addition point 37c shown In Figure 37) for additionally 
inputting the calculated correction amount to the dynamic model; and desired instantaneous value determining means 
(the gait generator (with full-model correction) 100, in particular to determine the output of the direct full-model 100c2 

45 shown in Figure 37 as the corrected desired body position andto determine the output of the model-followup feedback 
control law 37b shown in Figure 37 as the ZM P-converted value of full-model's corrected moment about the desired 
ZMP) for determining desired instantaneous values of the desired movement and the desired floor reaction force based 
on at least the input to and the output from the dynamic model. 

[0316] The sixteenth embodiment is also arranged to have a system for generating an instantaneous value of motion 
50 including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each connected to the 
body, when the robot performs the motion, comprising: desired floor reaction force provisional Instantaneous value 
determining means (the gait parameter determinator 1 00a and the desired (and provisional) instantaneous value gen- 
erator 1 00b shown in Figure 5) for determining a provisional instantaneous value of a desired floor reaction force that 
constitutes the motion; desired movement instantaneous value determining means (gait parameter determinator 1 00a 
55 and desired (and provisional) instantaneous value generator 1 00b shown in Figure 5, the calculation of the simplified 
model 100c1 shown in Figure 37) for determining an instantaneous value of a desired movement that constitutes the 
motion; model movement instantaneous value calculating means (the calculation of the direct full -model 100c2 shown 
in Figure 37) for inputting at least the determined provisional instantaneous value of the desired floor reaction force to 
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a dynamic model that expresses a relationship between the movement of the robot and a floor reaction force, and for 
calculating an Instantaneous value of the dynamic model's movement; model movement difference calculating means 
(the addition point 37a shown in Figure 37) for calculating a difference between the Instantaneous value of the dynamic 
model's movement and the instantaneous value of the desired movement; correction amount calculating means (the 

5 model-followup feedback control law 37b shown in Figure 37) for calculating a correction amount based on the differ- 
ence such that the difference approaches zero; model input correcting means (the addition point 37c shown In Figure 
37) for additionally inputting the calculated correction amount to the dynamic model; and desired floor reaction force 
instantaneous value determining means (100, in particular to determine the output of the model-followup feedback 
control law 37b shown in Figure 37 as the ZMP-con verted value of full-model's corrected moment about the desired 

10 ZMP) for determining a desired instantaneous value of the desired floor reaction force based on at least the input to 
the dynamic model. 

[0317] The sixteenth embodiment Is further arranged to have a system for generating an Instantaneous value of 
motion including walking of a legged mobile robot 1 having at [east a body 24 and a plurality of iegs 2 each connected 
to the body, when the robot performs the motion, comprising: provisional instantaneous value determining means (1 00a 
and 100b, the calculation of the simplified model 100c1 shown in Figure 37) for determining provisional Instantaneous 
values of a desired movement and a desired ZMP that constitute the motion; model movement instantaneous value 
calculating means (the calculation of the direct full-model 1 00c2 shown In Figure 37) for inputting at least the determined 
provisional instantaneous value of the desired ZMP to a dynamic model that expresses a relationship between the 
movement of the robot and a ZMP, and for calculating an instantaneous value of the dynamic model's movement; 

20 model movement difference calculating means (the addition point 37a shown In Figure 37) for calculating a difference 
between the instantaneous value of the dynamic model's movement and the determined provisional Instantaneous 
value of the desired movement; correction amount calculating means (37b) for calculating a correction amount based 
on the difference such that the difference approaches zero; model Input correcting means (the addition point 37c) for 
additionally inputting the calculated correction amount to the dynamic model; and desired Instantaneous value deter- 

25 mining means (1 00, in particular to determine the output of the direct full-model shown in Figure 37 as the corrected 
desired body position and to determine the output of the model-followup feedback control law 37b shown In Figure 37 
as the ZMP-converted value of fuil-model's corrected moment about the desired ZMP) for determining desired instan- 
taneous values of the desired movement and the desired ZMP based on at least the Input to and the output from the 
dynamic model. 

30 [0318] The sixteenth embodiment is further arranged to have a system for generating an Instantaneous value of 
motion including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each connected 
to the body, when the robot performs the motion, comprising: desired ZMP provisional instantaneous value determining 
means (1 00a and 1 00b) for determining provisional Instantaneous values of a desired ZMP that constitutes the motion; 
desired movement instantaneous value determining means (100a and 100b, the calculation of the simplified model 

35 1 ood shown in Figure 37) for determining an instantaneous value of a desired movement that constitutes the motion; 
model movem ent instantaneous value calculating means (the calculation of the direct full-model 1 00c2 shown In Figure 
37) for inputting at least the determined instantaneous value of the desired ZMP to a dynamic model that expresses 
a relationsh ip b etween the movement of the robot and a ZMP, and for caiculating an instantaneous value of the dynamic 
model's movement; model movement difference calculating means (the addition point 37a) for calculating a difference 

Jo between the instantaneous value of the dynamic model's movement and the instantaneous value of the desired move- 
ment; correction amount calculating means (37b) for calculating a correction amount based on the difference such that 
the difference approaches zero; model input correcting means (the addition point 37c) for additionally inputting the 
calculated correction amount to the dynamic model; and desired ZMP instantaneous value determining means (100, 
in particular to determine the output of the model-followup feedback control law 37b shown in Figure 37 as the ZMP- 

45 converted value of full-model's corrected moment about the desired ZMP) for determining a desired instantaneous 
value of the desired ZMP based on at least the input to the dynamic model. 

[0319] As mentioned above, the twenty-second embodiment is to have a system for generating an instantaneous 
value of motion including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each 
connected to the body, when the robot performs the motion, comprising: desired ZMP provisional Instantaneous value 

50 determining means (1 00a and 100b) for determining a provisional instantaneous value of a desired ZMP that constitutes 
the motion; desired movement Instantaneous value determining means (100a and 100b, the calculation of the simplified 
model 100c1 shown in Figure 43) for determining an Instantaneous value of a desired movement that constitutes the 
motion; model movement instantaneous value calculating means (the calculation of the direct full -model 100c2 shown 
in Figure 43) for inputting at least the determined instantaneous value of the desired ZMP to a dynamic model that 

55 expresses a relationship among the movement ofthe robot, apointof action of a floor reaction force and a floor reaction 
force's moment about the point, and for calculating an instantaneous value of the dynamic model's movement; model 
movement difference caiculating means (the addition point 43a) for calculating a difference between the Instantaneous 
value of the dynamic model's movement and the instantaneous value of the desired movement; correction amount 
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calculating means (the model-fa llowup feedback control law 43b) for calculating a correction amount based on the 
difference such that the difference approaches zero; and desired Instantaneous value determining means (100, in 
particular the block 43h and to determine the output of the model -followup feedback control law 43b shown in Figure 
43 as the ZMP-converted value of full-model's corrected moment about the desired ZMP) for inputting the calculated 

5 correction amountto the dynamic model as the floor reaction force's moment, and for determining thecorrection amount 
as a desired instantaneous value of corrected moment about the desired ZMP, while correcting the input to the model. 
[0320] As mentioned above, the seventeenth embodiment is arranged to have a system for generating an instanta- 
neous value of motion including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 
each connected to the body, when the robot performs the motion, comprising: desired floor reaction force Instantaneous 

10 value determining means (the gait parameter determinator 1 00a and the desired (and provisional) instantaneous value 
generator 1 00b shown in Figure 5) for determining an instantaneous value of at least a desired floor reaction force in 
a desired movement and the desired floor reaction force that constitute the motion; first model movement instantaneous 
value calculating means (the calculation of the simplified model 100c1 shown in Figure 38) for inputting at least the 
determined Instantaneous value of the desired floor reaction force to a first dynamic model that expresses a relationship 

is between the movement of the robot and a floor reaction force, and for calculating an instantaneous value of the first 
dynamic model's movement; second model movement Instantaneous value calculating means (the calculation of the 
direct full-model 100c2 shown in Figure 38) for inputting at least the determined instantaneous value of the desired 
floor reaction force to a second dynamic model that expresses the relationship between the movement of the robot 
and the floor reaction force, and for calculating instantaneous value of the second dynamic model's movement; model 

20 movement difference calculating means (the addition point 38a shown in Figure 38) for calculating a difference between 
the instantaneous value of the second dynamic model's movement and the instantaneous value of the first dynamic 
model's movement; correction amount calculating means (the model-foliowup feedback control law 38b shown in Figure 
38) for calculating a correction amount based on at least the difference such that the difference approaches zero; and 
first model input correcting means (the addition point 38c) for additionally inputting the calculated correction amount 

25 to the first dynamic model; and determines at least one of an output of the first dynamic model and an output of the 
second dynamic model as a desired instantaneous values of the desired movement (the gait generator (with full-model 
correction) 100 shown in Figure 4, in particular to determine the output of the simplified model 100c1 or the output of 
the direct full-model 1 00c2 shown in Figure 38 as the corrected desired body position). 

[0321] The seventeenth embodiment is also arranged to have a system for generating an instantaneous value of 

30 motion including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each connected 
to the body, when the robot performs the motion, comprising; desired ZMP instantaneous value determining means 
(100a, 100b) for determining an instantaneous value of at least a desired ZMP in a desired movement and the desired 
ZMP that constitute the motion; first model movement instantaneous value calculating means (the calculation of the 
simplified model 100c1 shown in Figure 38) for inputting at least the determined Instantaneous value of the desired 

35 ZMP to a first dynamic model that expresses a relationship between the movement of the robot and a ZMP, and for 
calculating an instantaneous value of the first dynamic model's movement; second model movement instantaneous 
value calculating means (the calculation of the direct full-model 1 00c2 shown in Figure 38) for inputting at least the 
determined instantaneous value of the desired ZMP to a second dynamic model that expresses the relationship be- 
tween the movement of the robot and the ZMP, and for calculating instantaneous value of the second dynamic model's 

40 movement; model movement difference calculating means (the addition point 38a) for calculating a difference between 
the instantaneous value of the second dynamic model's movement and the instantaneous value of the first dynamic 
model's movement; correction amount calculating means (38b) for calculating a correction amount based on at least 
the difference such that the difference approaches zero; and first model input correcting means (38c) for additionally 
inputting the calculated correction amount to the first dynamic model; and determines at least one of an output of the 

is first dynamic model and an output of the second dynamic model as a desired instantaneous values of the desired 
movement (the gait generator (1 00, in particular to determine the output of the simplified model 100c1 or the output of 
the direct full-model 1 00c2 shown in Figure 38 as the corrected desired body position). 

[0322] As mentioned above, the eighteenth embodiment is arranged to have a system for generating an instanta- 
neous value of motion including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 
50 each connected to the body, when the robot performs the motion, comprising: desired floor reaction force instantaneous 
value determining means (1 00a, 1 00b) for determining an instantaneous value of at least a desired floor reaction force 
in a desired movement and the desired floor reaction force that constitute the motion; first model movement Instanta- 
neous value calculating means (the calculation of the direct full-model 1 00c2 shown in Figure 39) for inputting at least 
the determined instantaneous value of the desired floor reaction force to a first dynamic model that expresses a rela- 
ys tionship between the movement of the robot and a floor reaction force, and for calculating an instantaneous value of 
the first dynamic model's movement; second model state quantity calculating means (the block 39a) for calculating a 
quantity of state of a second dynamic model corresponding to the instantaneous value of the first dynamic model's 
movement; and desired motion parameter correcting means (S28 in the flow chart of Figure 1 1) for correcting a pa- 
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rameter of a desired motion based on at least the quantity state of the second dynamic model; and determines an 
output of the first dynamic model as a desired instantaneous values of the desired movement (100, In particular to 
determine the output of the direct full-model 100c2 shown In Figure 39 as the corrected desired body position). 
[0323] The eighteenth embodiment is also arranged to have a system for generating an Instantaneous value of 

5 motion including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each connected 
to the body, when the robot performs the motion, comprising: desired ZMP instantaneous value determining means 
(100a, 1 00b) for determining an instantaneous value of at least a desired ZMP in a desired movement and the desired 
ZMP that constitute the motion; first model movement instantaneous value calculating means (the calculation of the 
direct full-model 100c2 shown in Figure 39) for inputting at (east the determined instantaneous value of the desired 

io ZMP to a first dynamic model that expresses a relationship between the movement of the robot and a ZMP, and for 
calculating an instantaneous value of the first dynamic model's movement; second model state quantity calculating 
means (39a) for calculating a quantity of state of a second dynamic model corresponding to the instantaneous value 
of the first dynamic model's movement; and desired motion parameter correcting means (S28 in the flow chart of Figure 
11 ) for correcting a parameter of a desired motion based on at least the quantity state of the second dynamic model; 

w and determines an output of the first dynamic model as a desired instantaneous values of the desired movement (1 00, 
in particular to determine the output of the direct full-model 100c2 shown in Figure 39 as the corrected desired body 
position). 

[0324J As mentioned above, the nineteenth embodiment is arranged to have a system for generating an instanta- 
neous value of motion including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 
20 each connected to the body, when the robot performs the motion, comprising; desired floor reaction force provisional 
instantaneous value determining means (100a, 100b) for determining a provisional instantaneous value of at least a 
desired floor reaction force in a desired movement and the desired floor reaction force that constitute the motion; first 
model movement instantaneous value calculating means (the calculation of the simplified model 100c1 shown in Figure 
40) for inputting at least the determined provisional Instantaneous value of the desired floor reaction force to a first 
dynamic model that expresses a relationship between the movement of the robot and a fioor reaction force, and for 
calculating an instantaneous value of the first dynamic model's movement; second model movement instantaneous 
value calculating means (the calculation of the direct full-model 100c2 shown in Figure 40) for Inputting at least the 
determined provisional instantaneous value of the desired floor reaction force to a second dynamic model that ex- 
presses the relationship between the movement of the robot and the floor reaction force, and for calculating an instan- 
ce taneous value of the second dynamic model's movement; model movement difference calculating means (the addition 
point 40a shown in Figure 40) for calculating a difference between the instantaneous value of the first dynamic model's 
movement and the instantaneous value of the second dynamic model's movement; first correction amount calculating 
means (the model-followup feedback control law 1 (40b)) for calculating a first correction amount based on the differ- 
ence such that the difference approaches zero; second correction amount calculating means (the model-foil owup feed- 
35 back control law 2 (40c)) for calculating a second correction amount based on the difference such that the difference 
approaches zero; first model Input correcting means (the addition point 40d) for additionally inputting the calculated 
first correction amount to the first dynamic model; and second model input correcting means (the addition point 40e) 
for additionally inputting the calculated second correction amount to the second dynamic model; and determines at 
least one of an output of the first dynamic model and an output of a second dynamic model as a desired instantaneous 
40 values of the desired movement (1 00, in particular to determine the output of the simplified model 1 00c1 or the output 
of the direct full-model 100c2 shown in Figure 40 as the corrected desired body position). 

[0325] The nineteenth embodiment Is also arranged to have a system for generating an instantaneous value of 
motion including walking of a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each connected 
to the body, when the robot performs the motion, comprising: desired ZMP provisional instantaneous value determining 

is means (100a, 100b) for determining a provisional instantaneous value of at least a desired ZMP In a desired movement 
and the desired ZMP that constitute the motion; first model movement instantaneous value calculating means (the 
calculation of the simplified model 100c1 shown In Figure 40) for inputting at least the determined provisional instan- 
taneous value of the desired ZMP to a first dynamic model that expresses a relationship between the movement of 
the robot and a ZMP, and for calculating an instantaneous value of the first dynamic model's movement; second model 

50 movement instantaneous value calculating means (the caiculation of the direct full -model 100c2 shown in Figure 40) 
for inputting at least the determined provisional Instantaneous value of the desired ZMP to a second dynamic model 
that expresses the relationship between the movement of the robot and the ZMP, and for calculating an Instantaneous 
value of the second dynamic model's movement; model movement difference calculating means (the addition point 
40a) for calculating a difference between the instantaneous value of the first dynamic model's movement and the 

55 instantaneous value of the second dynamic model's movement; first correction amount calculating means (40b) for 
calculating a first correction amount based on the difference such that the difference approaches zero; second correc- 
tion amount calculating means (40c) for calculating a second correction amount based on the difference such that the 
difference approaches zero; first model input correcting means (the addition point 40d) for additionally inputting the 
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calculated first correction amount to the first dynamic model; and second mode! input correcting means (the addition 
point 40e) for additionally inputting the calculated second correction amount to the second dynamic model; and deter- 
mines at least one of an output of the first dynamic model and an output of a second dynamic model as a desired 
instantaneous values of the desired movement (100, in particular to determine the output of the simplified mode! 100c1 

-5 or the output of the direct full-model 1 00c2 shown in Figure 40 as the corrected desired body position). 

[0326] As mentioned above, the twenty-third embodiment is arranged to further include: a second perturbation model 
(the second perturbation model 44a shown in Figure 44) that expresses a dynamic relationship between perturbation 
of the floor reaction force and perturbation of the movement of the robot; third feedback amount calculating means 
(the second perturbation model's control law 44b shown in Figure 44) for calculating a third feedback amount based 

io on at least one of a quantity of state of the second perturbation model and a quantity of state of the dynamic model; 
second feedforward amount calculating means (the second distributor 44c and the block 44d shown in Figure 44) for 
calculating a difference between the desired instantaneous value of the determined desired floor reaction force or the 
desired ZMP, and the provisional instantaneous value of the desired floor reaction force or the desired ZMP to input, 
and for calculating a second feedforward amount such that the difference decreases; and third desired movement 

fs correction amount calculating means (the addition point 44e and the perturbation model 44a shown in Figure 44) for 
inputting a sum of the third feedback amount and the second feedforward amount to the second perturbation model 
to calculate a third correction amount of the desired movement (the second perturbation model's body position shown 
in Figure 44). 

[0327] Further, it is arranged such that the third desired movement correction amount calculating means calculates 
20 the third correction amount of the desired movement, and calculates a third correction amount of the desired floor 
reaction force or the desired ZMP (the ZMP-converted value of full-model's corrected amount about the desired ZMP 
shown in Figure 44) by adding a sum of the calculated third feedback amount and the second feedforward amount, to 
the difference between the desired instantaneous value of the determined desired floor reaction force or the desired 
ZMP, and the provisional instantaneous value of the desired floor reaction force or the desired ZMP. 
25 [0328] Further, it is arranged such that the perturbation model comprises an inverted pendulum. 

[0329] Further, it is arranged such that second perturbation model comprises an inverted pendulum. 
[0330] Further, it is arranged to further include: desired motion parameter correcting means (S28 In the flow chart of 
Figure 11) for determining or correcting a parameter of desired motion based on a quantity of state of the dynamic 
model (the dynamic model's poison and/or velocity). 
so [0331] It should further be noted that, in the foregoing embodiments, although the present Invention has been de- 
scribed with reference to a biped robot, the present invention can also be applied to any other legged mobile robots 
having legs of three or more. 

[0332] It should further be noted that, the present invention can be applied not only to actual robots, but also to the 
motion control or motion generation in virtual robots in simulation or in a computer game. 

35 

INDUSTRIAL FIELD IN WHICH THE INVENTION IS APPLICABLE 

[0333] According to the present invention, there is provided a motion generation system of a legged mobile robot, 
in which provisional instantaneous values of a desired movement and a desired floor reaction force or ZMP (that 

40 constitute a motion) are determined, a model's floor reaction force or ZMP is then calculated based on the determined 
provisional instantaneous values of the desired movement, using a dynamic model that expresses a relationship be- 
tween the robot movement and the floor reaction force or ZMP, a difference between the calculated model's floor 
reaction force and the determined provisional instantaneous value of the desired floor reaction force, or a difference 
between the calculated model's ZMP and the determined instantaneous value of the desired ZMP is then calculated, 

■*5 and instantaneous values of the desired movement and the desired floor reaction force are determined by correcting 
at least the provisional Instantaneous value of the desired movement based on the calculated difference such that the 
relationship between the movement and the floor reaction force expressed by the dynamic model is satisfied. With 
this, the system can generate a motion such as a gait that satisfies the dynamic equilibrium condition accurately, and 
can improve the stability during walking or operations. 

so [0334] Further, since the system is arranged such that, a desired movement that defines the robot motion is deter- 
mined, a desired floor reaction force is then calculated based on the determined desired movement, using the dynamic 
mode! that expresses the relationship between the robot motion and the floor reaction force, and the floor reaction 
force actually acting on the robot is controlled based on the calculated desired floor reaction force, the system can 
generate a motion such as a gait that satisfies the dynamic equilibrium condition accurately, and can improve posture 

55 stability of the robot by controlling the robot to follow up the generated motion. 
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Claims 

1 . A system for generating a motion including walking of a legged mobile robot having at least a body and a plurality 
of legs each connected to the body, comprising: 

5 

a. desired movement determining means for determining a desired movement that defines the motion; 

b. desired floor reaction force calculating means for calculating a desired floor reaction force based on at least 
the determined desired movement, using a dynamic model that expresses a relationship between the move- 
ment of the robot and a floor reaction force; and 

0 c. floor reaction force controlling means for controlling the floor reaction force actually acting on the robot 

based on at least the calculated floor reaction force. 

2. A system for generating a motion including walking of a legged mobile robot having at least a body and a plurality 
of legs each connected to the body, comprising: 

a. desired motion determining means for determining a desired movement and a desired ZMP that define the 
motion; 

b. desired ZMP correction amount calculating means for calculating a correction amount of the desired ZMP 
based on at least the determined desired movement and the desired ZMP, using a dynamic model that ex- 

20 p resses a relationship between the movement of the robot and a ZMP; and 

c. floor reaction force controlling means for controlling the floor reaction force actually acting on the robot 
based on at least the calculated correction amount of the desired ZMP. 

3. A system for generating a motion Including walking of a legged mobile robot having at least a body and a plurality 
25 of legs each connected to the body, comprising: 

a. desired motion determining means for determining a desired movement and a point of action of a desired 
floor reaction force that define the motion; 

b. desired floor reaction force momentcalculating means for calculating a desired floor reaction force's moment 
30 about the point of action of the desired floor reaction force based on at least the desired movement and the 

point of action of the desired fl oor reaction force, using a dynamic model that expresses a relationship between 
the movement of the robot and a floor reaction force; and 

c. floor reaction force controlling means for controlling the floor reaction force actually acting on the robot 
based on at least the calculated desired floor reaction force's moment. 

35 

4. A system for generating an instantaneous value of motion Including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. provisional instantaneous value determining means for determining provisional instantaneous values of a 
40 desired movement and a desired floor reaction force that constitute the motion; 

b. model floor reaction force calculating means for calculating a model's floor reaction force based on at least 
the determined provisional Instantaneous value of the desired movement, using a dynamic model that ex- 
presses a relationship between the movement of the robot and a floor reaction force; 

c. floor reaction force difference calculating means for calculating a difference between the calculated model's 
45 floor reaction force and the determined provisional Instantaneous value of the desired floor reaction force; and 

d. desired instantaneous value determining means for determining a desired Instantaneous value of the desired 
movement, by correcting at least the provisional instantaneous value of the desired movement based on at 
least the calculated difference. 

53 5. A system for generating an instantaneous value of motion including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. provisional Instantaneous value determining means for determining provisional Instantaneous values of a 
desired movement and a desired ZMP that constitute the motion; 
55 b. model ZMP calculating means for calculating a model's ZMP based on at least the determined provisional 

instantaneous value of the desired movement, using a dynamic model that expresses a relationship between 
the movement of the robot and a ZMP; 

c. ZMP difference calculating means for calculating a difference between the calculated model's ZMP and the 
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determined provisional instantaneous value of the desired ZMP; and 

d. desired instantaneous value determining means for determining a desired Instantaneous value of the desired 
movement, by correcting at feast the provisional instantaneous value of the desired movement based on at 
least the calculated difference. 

A system for generating an instantaneous value of motion including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. provisional instantaneous value determining means for determining provisional instantaneous values of a 
desired movement and a desired ZMP that constitute the motion; 

b. model floor reaction force moment calculating means for calculating a model floor reaction force's moment 
about the provisional instantaneous value of the desired ZMP based on at least the determined provisional 
instantaneous values of the desired movement and the desired ZMP, using a dynamic model that expresses 
a relationship between the movement of the robot and a floor reaction force; and 

c. desired instantaneous value determining means for determining a desired instantaneous value of the desired 
movement, by correcting at least the provisional Instantaneous value of the desired movement based on at 
least the calculated model floor reaction force's moment. 

A system for generating an instantaneous value of motion including walking of a legged mobiie robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising; 

a. provisional instantaneous value determining means for determining provisional instantaneous values of a 
desired movement and a desired floor reaction force that constitute the motion; 

b. model floor reaction force calculating means for calculating a model's floor reaction force based on at least 
the determined provisional instantaneous value of the desired movement, using a dynamic model that ex- 
presses a relationship between the movement of the robot and a floor reaction force; 

c. floor reaction force difference calculating means for calculating a difference between the calculated model's 
floor reaction force and the determined provisional Instantaneous value of the desired floor reaction force; and 

d. desired instantaneous value determining means for determining desired instantaneous values of the desired 
movement and the desired floor reaction force, by correcting at least the provisional instantaneous value of 
the desired movement based on at least the calculated difference such that the relationship between the 
movement and the floor reaction force is satisfied. 

A system for generating an instantaneous value of motion including walking of a legged mobile robot having at 
feast a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. provisional instantaneous value determining means for determining provisional instantaneous values of a 
desired movement and a desired ZMP that constitute the motion; 

b. model ZMP calculating means for calculating a model's ZMP based on at least the determined provisional 
instantaneous value of the desired movement, using a dynamic model that expresses a relationship between 
the movement of the robot and a ZMP; 

c. ZMP difference calculating means for calculating a difference between the calculated model's ZMP and the 
determined provisional instantaneous value of the desired ZMP; and 

d. desired instantaneous value determining means for determining desired instantaneous values of the desired 
movement and the desired floor reaction force such that the relationship between the movement and the floor 
reaction force is satisfied, by correcting at least the provisional Instantaneous value of the desired movement 
based on at least the calculated difference. 

A system for generating an instantaneous value of motion including walking of a legged mobile robot having at 
[east a body and a plurality of fegs each connected to the body, when the robot performs the motion, comprising: 

a. provisional instantaneous value determining means for determining provisional instantaneous values of a 
desired movement and a desired ZMP that constitute the motion; 

b. model floor reaction force moment calculating means for calculating a model floor reaction force's moment 
about the provisional instantaneous value of the desired ZMP based on at least the determined provisional 
instantaneous values of the desired movement and the desired ZMP, using a dynamic model that expresses 
a relationship between the movement of the robot and a floor reaction force; and 

c. desired instantaneous value determining means for determining a desired instantaneous values of the de- 
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sired movement and the desired floor reaction force, by correcting at leastthe provisional Instantaneous value 
of the desired movement based on at least the calculated model floor reaction force's moment such that the 
relationship between the movement and the floor reaction force is satisfied. 

10. A system for generating an Instantaneous value of motion including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. provisional instantaneous value determining means for determining provisional instantaneous values of a 
desired movement and a desired floor reaction force that constitute the motion; 

b. model output calculating means for inputting at leastthe determined provisional instantaneous value of the 
desired movement to a dynamic model that expresses a relationship between the movement of the robot and 
a floor reaction force, and for calculating an output of the model; 

c. floor reaction force difference calculating means for calculating a difference between the calculated output 
of the model and the determined provisional instantaneous value of the desired floor reaction force; 

d. desired movement correction amount calculating means for calculating a correction amount of at least the 
desired movement based on at leastthe calculated difference; 

e. model input correcting means for additionally inputting the calculated correction amount to the dynamic 
model; and 

f. desired instantaneous value determining means for determining desired instantaneous values of the desired 
movement and the desired floor reaction force based on at least the Input to and the output from the dynamic 
model. 

11 . A system for generating an instantaneous value of motion including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. provisional instantaneous value determining means for determining provisional instantaneous values of a 
desired movement and a desired ZMP that constitute the motion; 

b. model output calculating means for inputting at leastthe determined provisional Instantaneous value of the 
desired movement to a dynamic mode! that expresses a relationship between the movement of the robot and 
a ZMP, and for calculating an output of the model; 

c. ZMP difference calculating means for calculating a difference between the calculated output of the mode! 
and the determined provisional instantaneous value of the desired ZMP; 

d. desired movement correction amount calculating means for calculating a correction amount of at least the 
desired movement based on at least the calculated difference; 

e. model input correcting means for additionally Inputting the calculated correction amount to the dynamic 
model; and 

f. desired instantaneous value determining means for determining desired instantaneous values of the desired 
movement and the desired floor reaction force based on at least the Input to and the output from the dynamic 
model. 

12. A system for generating an instantaneous value of motion including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. provisional instantaneous value determining means for determining provisional instantaneous values of a 
desired movement and a desired ZMP that constitute the motion; 

b. model output calculating means for inputting at least the determined provisional Instantaneous values of 
the desired movement and the desired ZMP to a dynamic model that expresses a relationship between the 
movement of the robot and a floor reaction force's moment about a point of action of a floor reaction force, 
and for calculating an output of the model as a floor reaction force's moment about the provisional instanta- 
neous vaiue of the desired ZMP; 

c. desl red movement correction amount calculating means for calculating a correction amount of at least the 
desired movement based on at leastthe output of the model; 

d. model input correcting means for additionally inputting the calculated correction amount to the dynamic 
model; and 

e. desired instantaneous value determining means for determining desired instantaneous values of the desired 
movement and the desired floor reaction force based on at least the input to and the output from the dynamic 
model. 
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13. A system according to claim 10, wherein the desired movement correction amount calculating means includes: 

g. a perturbation model that expresses a dynamic relationship between perturbation of the floor reaction force 
and perturbation of the movement of the robot; 

5 h. first feedback amount calculating means for calculating a first feedback amount based on at least one of a 

quantity of state of the perturbation model and a quantity of state of the dynamic model; and 
i. second feedback amount calculating means for calculating a second feedback amount based on at least a 
difference between the calculated difference and the first feedback amount; 

10 and calculates the correction amount of the desired movement by inputting a sum of the first and second 

feedback amounts to the perturbation model. 

14. A system according to cfaim 11 , wherein the desired movement correction amount calculating means includes: 

15 g. a perturbation model that expresses a dynamic relationship between perturbation of the ZMP and pertur- 

bation of the movement of the robot; 

h. first feedback amount calculating means for calculating a first feedback amount based on at least one of a 
quantity of state of the perturbation model and a quantity of state of the dynamic model; and 

i. second feedback amount calcuiating means for calculating a second feedback amount based on at least a 
20 difference between the calculated difference and the first feedback amount; 

and calculates the correction amount of the desired movement by inputting a sum of the first and second 
feedback amounts to the perturbation model. 

25 15. A system according to claim 12, wherein the desired movement correction amount calculating means includes: 

f. a perturbation model that expresses a dynamic relationship between perturbation of the floor reaction force's 
moment and perturbation of the movement of the robot; 

g. first feedback amount calculating means for calculating a first feedback amount based on at least one of a 
oo quantity of state of the perturbation model and a quantity of state of the dynamic model; and 

h. second feedback amount calculating means for calculating a second feedback amount based on at least a 
difference between the calculated difference and the first feedback amount; 

and calculates the correction amount of the desired movement by inputting a sum of the first and second 
55 feedback amounts to the perturbation model. 

16. A system according to any of claims 13 to 15, wherein the first feedback amount calcuiating means calculates the 
first feedback amount based on at least the dynamic model's center of gravity position. 

40 17. A system for generating an instantaneous value of motion Including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. provisional instantaneous value determining means for determining provisional instantaneous values of a 
desired movement and a desired floor reaction force that constitute the motion; 
45 b. model output calculating means for inputting at least the determined provisional instantaneous value of the 

desired movement to a dynamic model that expresses a relationship between the movement of the robot and 
a floor reaction force, and for calculating an output of the model; 

c. floor reaction force difference calculating means for calculating a difference between the calculated output 
of the model and the determined provisional instantaneous value of the desired floor reaction force; 
50 d. desired movement correction amount calculating means for calculating a correction amount of at least the 

desired movement based on at least the calculated difference; and 

e. desired instantaneous value determining means for determining desired instantaneous values of the desired 
movement and the desired floor reaction force based on at least the calculated correction amount 

55 18. A system for generating an instantaneous value of motion including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. provisionai instantaneous value determining means for determining provisional instantaneous values of a 
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desired movement and a desired ZMP that constitute the motion; 

b. model output calculating means for Inputting at least the determined provisional instantaneous value of the 
desired movement to a dynamic model that expresses a relationship between the movement of the robot and 
a ZMP, and for calculating an output of the model; 

c. ZMP difference calculating means for calculating a difference between the calculated output of the model 
and the determined provisional instantaneous value of the desired ZMP; 

d. desired movement correction amount calculating means for calculating a correction amount of at least the 
desired movement based on at least the calculated difference; and 

e. desired instantaneous value determining means for determining desired instantaneous values of the desired 
movement and the desired floor reaction force based on at least the calculated correction amount. 

19. A system for generating an instantaneous value of motion including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. provisional instantaneous value determining means for determining provisional instantaneous values of a 
desired movement and a desired ZMP that constitute the motion; 

b. model output calculating means for Inputting at least the determined provisional instantaneous value of the 
desired movement to a dynamic model that expresses a relationship between the movement of the robot and 
a floor reaction force's moment about a point of action of the floor reaction, and for calculating an output of 
the model as a floor reaction force's moment about the provisional instantaneous value of the desired ZMP; 

c. desired movement correction amount calculating means for calculating a correction amount of at least the 
desired movement based on at least the output of the model; and 

d. desired instantaneous value determining means for determining desired instantaneous values of the desired 
movement and the desired floor reaction force based on at least the calculated correction amount, 

20. A system according to claim 17, wherein the desired movement correction amount calculating means includes: 

f. a perturbation model that expresses a dynamic relationship between perturbation of the floor reaction force 
and perturbation of the movement of the robot; 

g. feedback amount calculating means for calculating a feedback amount based on at least one of a quantity 
of state of the perturbation model and a quantity of state of the dynamic model; and 

h. feedforward amount calculating means for calculating a feedforward amount such that the calculated dif- 
ference Is canceled; 

and calculates the correction amount of the desired movement by inputting a sum of the feedback amount 
and the feedforward amount to the perturbation model. 

21 . A system according to claim 18, wherein the desired movement correction amount calculating means includes: 

f. a perturbation model that expresses a dynamic relationship between perturbation of the ZMP and perturba- 
tion of the movement of the robot; 

g. feedback amount calculating means for calculating a feedback amount based on at least one of a quantity 
of state of the perturbation model and a quantity of state of the dynamic model; and 

h. feedforward amount calculating means for calculating a feedforward amount such that the calculated dif- 
ference is canceled; 

and calculates the correction amount of the desired movement by Inputting a sum of the feedback amount 
and the feedforward amount to the perturbation mode!. 

22. A system according to claim 19, wherein the desired movement correction amount calculating means includes: 

e. a perturbation model that expresses adynamic relationship between perturbation of the floor reaction force 
and perturbation of the movement of the robot; 

f. feedback amount calculating means for calculating a feedback amount based on at least one of a quantity 
of state of the perturbation model and a quantity of state of the dynamic model; and 

g. feedforward amount calculating means for calculating a feedforward amount such that an output of the 
dynamic model is canceled; 
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and calculates the correction amount of the desired movement by Inputting a sum of the feedback amount 
and the feedforward amount to the perturbation modei. 

23. A system according to any of claims 20 to 22, wherein the first feedback amount calculating means calculates the 
first feedback amount based on at least a position of the dynamic model's center of gravity. 

24. A system for generating an instantaneous value of motion including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. desired floor reaction force provisional instantaneous value determining means for determining a provisional 
instantaneous value of at least a desired floor reaction force in a desired movement and the desired floor 
reaction force that constitute the motion; 

b. desired movement provisional instantaneous value calculating means for inputting at least the determined 
provisional instantaneous value of the desired floor reaction force to a first dynamic model that expresses a 
relationship between the movement of the robot and a floor reaction force, and for calculating a provisional 
instantaneous value of the desired movement; 

c. second model output calculating means for inputting at least the determined provisional instantaneous value 
of the desired movement to a second dynamic model that expresses the relationship between the movement 
of the robot and the floor reaction force, and for calculating an output of the second dynamic model; 

d. floor reaction force difference calculating means for calculating a difference between the calculated output 
of the second dynamic model and the determined provisional Instantaneous value of the desired floor reaction 
force; 

e. desired floor reaction force correction amount calculating means for calculating a correction amount of at 
least the desired floor reaction force based on at least the calculated difference; 

f . model input correcting means for additionally inputting the calcu lated correction amount to the first dynamic 
model; and 

g. desired instantaneous value determining means for determining desired Instantaneous values of the desired 
movement and the desired floor reaction force based on at least the input to and output from the second 
dynamic model. 

25. A system for generating an instantaneous value of motion including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. desired ZMP provisional instantaneous value determining means for determining a provisional instantane- 
ous value of at least a desired ZMP in a desired movement and the desired ZMP that constitute the motion; 

b. desired movement provisional instantaneous value calculating means for inputting at least the determined 
provisional instantaneous value of the desired ZMP to a first dynamic model that expresses a relationship 
between the movement of the robot and a ZMP, and for calculating a provisional instantaneous value of the 
desired movement; 

c. second model output calculating means for inputting at least the determined provisional instantaneous value 
of the desired movement to a second dynamic model that expresses a relationship between the movement 
of the robot and the ZMP, and for calculating an output of the second dynamic modei; 

d. ZMP difference calculating means for calculating a difference between the calculated output of the second 
dynamic model and the determined provisional instantaneous value of the desired ZMP; 

e. desired ZMP correction amount calculating means for calculating a correction amount of at least the desired 
ZMP based on at least the calculated difference; 

f. model input correcting means for additionally inputting the calculated correction amount to the first dynamic 
model; and 

g. desired instantaneous value determining means for determining desired instantaneous values of the desired 
movement and the desired floor reaction force based on at least the input to and output from the second 
dynamic model. 

26. A system for generating an instantaneous value of motion including walking of a legged moblie robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. desired ZMP provisional instantaneous value determining means for determining a provisional instantane- 
ous value of at least a desired ZMP in a desired movement and the desired ZMP that constitute the motion; 

b. desired movement provisional instantaneous value calculating means for inputting at least the determined 
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provisional Instantaneous value of the desired ZMP to a first dynamic model that expresses a relationship 
between the movement of the robot and a ZMP, and for calculating a provisional Instantaneous value of the 
desired movement; 

c. second model output calculating means for inputting at least the calculated provisional instantaneous value 
of the desired movement and the determined provisional instantaneous value of the desired ZMP to a second 
dynamic model that expresses a relationship between the movement of the robot and a floor reaction force's 
moment about a point of action of the floor reaction force, and for calculating an output of the second dynamic 
model as a floor reaction force's moment about the Instantaneous value of the desired ZMP; 

d. desired ZM P correction amount calculating means for calculating a correction amount of at leastthe desired 
ZMP based on at least the calculated output of the second dynamic model; 

e. model input correcting means for additionally inputting the calculated correction amount to the first dynamic 
model; and 

f. desired instantaneous vatue determining means for determining desired instantaneous values of the desired 
movement and the desired floor reaction force based on at least the Input to and output from the second 
dynamic model. 

27. A system according to claim 24, further including: 

h. desired movement correction amount calculating means for calculating a correction amount of at least the 
desired movement based on at least the calculated difference; and 

I. second model input correcting means for additionally inputting the calculated correction amount of the desired 
movement to the second dynamic model. 

28. A system according to claim 25, further including: 

h. desired movement correction amount calculating means for calculating a correction amount of at leastthe 
desired movement based on at leastthe calculated difference; and 

i . second model input correcting means for additionally Inputtlngthecalculated correction amount of the desired 
movement to the second dynamic model. 

29. A system according to claim 26, further including: 

g. desired movement correction amount calculating means for calculating a correction amount of at least the 
desired movement based on at least the calculated output of the second model; and 

h. second model input correcting means for additionally Inputting the calculated correction amount of the de- 
sired movement to the second dynamic model. 

30. A system according to cfaim 27, wherein the desired movement correction amount calculating means includes: 

j. a perturbation model that expresses a dynamic relationship between perturbation of the floor reaction force 
and perturbation of the movement of the robot; 

k. first feedback amount calculating means for calculating a first feedback amount based on at least one of a 
quantity of state of the perturbation model and a quantity of state of the dynamic model; and 
I. second feedback amount calculating means for calculating a second feedback amount based on at least a 
difference between the calculated difference and the first feedback amount; 

and calculates the correction amount of the desired movement by Inputting a sum of the first and second 
feedback amounts to the perturbation model. 

31. A system according to claim 28, wherein the desired movement correction amount calculating means includes: 

). a perturbation model that expresses a dynamic relationship between perturbation of the ZMP and perturba- 
tion of the movement of the robot; 

k. first feedback amount calculating means for calculating a first feedback amount based on at least one of a 
quantity of state of the perturbation model and a quantity of state of the dynamic model; and 
I. second feedback amount calculating means for calculating a second feedback amount based on at least a 
difference between the calculated difference and the first feedback amount; 
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and calculates the correction amount of the desired movement by inputting a sum of the first and second 
feedback amounts to the perturbation model. 

32. A system according to claim 29, wherein the desired movement correction amount calculating means includes: 

5 

i . a perturbation model that expresses a dynamic relationship between perturbation of the floor reaction force's 
moment and perturbation of the movement of the robot; 

j, first feedback amount calculating means for calculating a first feedback amount based on at least one of a 
quantity of state of the perturbation model and a quantity of state of the dynamic model; and 
10 k, second feedback amount calculating means for calculating a second feedback amount based on at least a 

difference between the output of the model and the first feedback amount; 

and calculates the correction amount of the desired movement by inputting a sum of the first and second 
feedback amounts to the perturbation model. 

15 

33. A system for generating an instantaneous value of motion including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. provisional instantaneous value determining means for determining provisional instantaneous values of a 
20 desired movement and a desired floor reaction force that constitute the motion; 

b. model movement instantaneous value calculating means for inputting the determined provisional instanta- 
neous value of the desired floor reaction force to a dynamic model that expresses a relationship between the 
movement of the robot and a floor reaction force, and for calculating an instantaneous value of the dynamic 
model's movement; 

25 c. model movement difference calculating means for calculating a difference between the instantaneous value 

of the dynamic model's movement and the determined provisional instantaneous value of the desired move- 
ment; 

d. correction amount calculating means for calculating a correction amount based on the difference such that 
the difference approaches zero; 
30 e. model input correcting means for additionally inputting the calculated correction amount to the dynamic 

model; and 

f. desired instantaneous value determining means for determining desired instantaneous values of the desired 
movement and the desired floor reaction force based on at least the input to and the output from the dynamic 
model. 

35 

34. A system for generating an instantaneous value of motion including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. desired floor reaction force provisional instantaneous value determining means for determining a provisional 
40 instantaneous value of a desired floor reaction force that constitutes the motion; 

b. desired movement instantaneous value determining means for determining an instantaneous value of a 
desired movement that constitutes the motion; 

c. model movement instantaneous value calculating means for inputting at least the determined provisional 
instantaneous value of the desired floor reaction force to a dynamic model that expresses a relationship be- 

45 tween the movement of the robot and a floor reaction force, and for calculating an instantaneous vaiue of the 

dynamic model's movement; 

d. model movement difference calculating means for calculating a difference between the instantaneous value 
of the dynamic model's movement and the instantaneous vaiue of the desired movement; 

e. correction amount calculating means for calculating a correction amount based on the difference such that 
50 the difference approaches zero; 

f. model input correcting means for additionally Inputting the calculated correction amount to the dynamic 
model; and 

g. desired floor reaction force instantaneous value determining means for determining a desired instantaneous 
value of the desired floor reaction force based on at least the input to the dynamic model. 

55 

35. A system for generating an instantaneous value of motion including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 
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a. provisional Instantaneous value determining means for determining provisional instantaneous values of a 
desired movement and a desired ZMP that constitute the motion; 

b. model movement instantaneous value calculating means for inputting at least the determined provisional 
instantaneous value of the desired ZMP to a dynamic model that expresses a relationship between the move- 

5 ment of the robot and a ZMP, and for calculating an instantaneous value of the dynamic model's movement; 

c. model movement difference calculating means for calculating a difference between the Instantaneous value 
of the dynamic model's movement and the determined provisional instantaneous value of the desired move- 
ment; 

d. correction amount calculating means for calculating a correction amount based on the difference such that 
10 the difference approaches zero; 

e. model input correcting means for additionally inputting the calculated correction amount to the dynamic 
model; and 

f. desired instantaneous value determining means for determining desired instantaneous values of the desired 
movemen t and the desired ZMP based on at least the Input to and the output from the dynamic model. 

15 

36. A system for generating an instantaneous value of motion including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. desired ZM P provisional instantaneous value determin ing means for determining provisional instantaneous 
20 values of a desired ZMP that constitutes the motion; 

b. desired movement instantaneous value determining means for determining an instantaneous value of a 
desired movement that constitutes the motion; 

c. model movement instantaneous value calculating means for inputting at least the determined instantaneous 
value of the desired ZMP to a dynamic model that expresses a relationship between the movement of the 

25 robot and a ZMP, and for calculating an instantaneous value of the dynamic model's movement; 

d. model movement difference calculating means for calculating a difference between the Instantaneous value 
of the dynamic model's movement and the instantaneous value of the desired movement; 

e. correction amount calculating means for calculating a correction amount based on the difference such that 
the difference approaches zero; 

30 f. model input correcting means for additionally inputting the calculated correction amount to the dynamic 

model; and 

g. desired ZMP instantaneous value determining means for determining a desired instantaneous value of the 
desired ZMP based on at ieast: the input to the dynamic model. 

35 37. A system for generating an instantaneous value of motion including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. desired ZMP provisional instantaneous value determining means for determining a provisional instantane- 
ous value of a desired ZMP that constitutes the motion; 
40 b. desired movement instantaneous value determining means for determining an instantaneous value of a 

desired movement that constitutes the motion; 

c. model movement Instantaneous value calculating means for Inputting at least the determined Instantaneous 
value of the desired ZMP to a dynamic model that expresses a relationship among the movement of the robot, 
a point of action of a floor reaction force and a floor reaction force's moment about the point, and for calculating 

45 an instantaneous value of the dynamic model's movement; 

d. model movement difference calculating means for calculating a difference between the Instantaneous value 
of the dynamic model's movement and the Instantaneous value of the desired movement; 

e. correction amount calculating means for calculating a correction amount based on the difference such that 
the difference approaches zero; and 

so f. desired instantaneous value determin ing means for inputting the calculated correction amountto the dynamic 

model as the floor reaction force's moment, and for determining the correction amount as a desired Instanta- 
neous value of corrected moment about the desired ZMP, while correcting the Input to the model. 

38. A system for generating an Instantaneous value of motion including walking of a legged mobile robot having at 
55 least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. desired floor reaction force Instantaneous value determining means for determining an Instantaneous value 
of at feast a desired floor react on force in a desired movement and the desired floor reaction force that con- 
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stitute the motion; 

b. first model movement instantaneous value calculating means for inputting at least the determined Instan- 
taneo us value of the desired floor reaction force to a first dynamic model that expresses a relationship between 
the movement of the robot and a floor reaction force, and for calculating an instantaneous value of the first 
dynamic model's movement; 

c. second model movement instantaneous value calculating means for inputting at least the determined In- 
stantaneous value of the desired floor reaction force to a second dynamic model that expresses the relationship 
between the movement of the robot and the floor reaction force, and for calculating instantaneous value of 
the second dynamic model's movement; 

d. model movement difference calculating means forcalculating a difference between the instantaneous value 
of the second dynamic model's movement and the instantaneous value of the first dynamic model's movement; 

e. correction amount calculating means forcalculating a correction amount based on at least the difference 
such that the difference approaches zero; and 

f. first model input correcting means for additionally inputting the calculated correction amount to the first 
dynamic model; 

and determines at least one of an output of the first dynamic model and an output of the second dynamic 
mode! as a desired instantaneous values of the desired movement. 

39. A system for generating an instantaneous value of motion including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. desired ZMP Instantaneous value determining means for determining an instantaneous value of at least a 
desired ZMP in a desired movement and the desired ZMP that constitute the motion; 

b. first model movement instantaneous value calculating means for inputting at least the determined instan- 
taneous value of the desired ZMP to a first dynamic model that expresses a reiationsh ip between the movement 
of the robot and a ZMP, and for calculating an Instantaneous value of the first dynamic model's movement; 

c. second model movement instantaneous value calculating means for inputting at least the determined in- 
stantaneous vaiue of the desired ZMP to a second dynamic model that expresses the relationship between 
the movement of the robot and the ZMP, and for calculating instantaneous value of the second dynamic model's 
movement; 

d. model movement difference calculating means forcalculating a difference between the instantaneous value 
of the second dynamic model's movement and the instantaneous value of thefirst dynamic model's movement; 

e. correction amount calculating means for calculating a correction amount based on at ieast the difference 
such that the difference approaches zero; and 

f. model input correcting means for additionally inputting the calculated correction amount to thefirst dynamic 
model; 

and determines at least one of an output of the first dynamic model and an output of the second dynamic 
model as a desired instantaneous values of the desired movement. 

40. A system for generating an instantaneous value of motion Including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. desired floor reaction force instantaneous value determining means for determining an instantaneous value 
of at least a desired floor reaction force in a desired movement and the desired floor reaction force that con- 
stitute the motion; 

b. first model movement instantaneous value calculating means for Inputting at least the determined Instan- 
taneous vaiue of the desired floor reaction force to a first dynamic model that expresses a relationship between 
the movement of the robot and a floor reaction force, and for calculating an instantaneous value of the first 
dynamic model's movement; 

c. second model state quantity calculating means forcalculating a quantity of state of a second dynamic model 
corresponding to the instantaneous value of the first dynamic model's movement; and 

d. desired motion parameter correcting means for correcting a parameter of a desired motion based on at 
least the quantity state of the second dynamic model; 

and determines an output of the first dynamic model as a desired instantaneous values of the desired move- 
ment. 
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41 . A system for generating an instantaneous value of motion Including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. desired ZMP Instantaneous value determining means for determining an instantaneous value of at least a 
desired ZMP in a desired movement and the desired ZMP that constitute the motion; 

b. first model movement instantaneous value calculating means for inputting at least the determined instan- 
tan eo us value of the desired ZMP to a first dynamic model that expresses a relationship between the movement 
of the robot and a ZMP, and for calculating an instantaneous value of the first dynamic model's movement; 

c. second model state quantity calculating means for calculating a quantity of state of a second dynamic model 
corresponding to the instantaneous value of the first dynamic model's movement; and 

d. desired motion parameter correcting means for correcting a parameter of a desired motion based on at 
least the quantity state of the second dynamic model; 

and determines an output of the first dynamic model as a desired instantaneous values of the desired move- 
ment. 

42. A system for generating an instantaneous value of motion including walking of a legged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. desired floor reaction force provisional Instantaneous value determining means for determining a provisional 
instantaneous value of at least a desired floor reaction force in a desired movement and the desired floor 
react! on force that constitute the motion; 

b. first model movement instantaneous value calculating means for inputting at least the determined provisional 
instantaneous value of the desired floor reaction force to a first dynamic model that expresses a relationship 
between the movement of the robot and a floor reaction force, and for calculating an instantaneous value of 
the first dynamic model's movement; 

c. second model movement instantaneous value calculating means for inputting at least the determined pro- 
visional instantaneous value of the desired floor reaction force to a second dynamic model that expresses the 
relationship between the movement of the robot and the floor reaction force, and for calculating an instanta- 
neous value of the second dynamic model's movement; 

d. model movement difference calculating means for calculating a difference between the instantaneous value 
of the first dynamic model's movement and the instantaneous value of the second dynamic modei's movement; 

e. first correction amount calculating means for calculating a first correction amount based on the difference 
such that the difference approaches zero; 

f. second correction amount calculating means for calculating a second correction amount based on the dif- 
ference such that the difference approaches zero; 

g. first model input correcting means for additionally inputting the calculated first correction amount to the first 
dynamic model; and 

h. second model input correcting means for additionally inputting the calculated second correction amount to 
the second dynamic model; 

and determines at least one of an output of the first dynamic model and an output of a second dynamic model 
as a desired instantaneous values of the desired movement. 

43. A system for generating an instantaneous value of motion including walking of a iegged mobile robot having at 
least a body and a plurality of legs each connected to the body, when the robot performs the motion, comprising: 

a. desired ZMP provisional Instantaneous value determining means for determining a provisional Instantane- 
ous value of at least a desired ZMP in a desired movement and the desired ZMP that constitute the motion; 

b. first model movement instantaneous value calculating means for inputting at least the determined provisional 
Instantaneous value of the desired ZMP to a first dynamic model that expresses a relationship between the 
movement of the robot and a ZMP, and for calculating an Instantaneous value of the first dynamic model's 
movement; 

c. second model movement instantaneous value calculating means for inputting at least the determined pro- 
visional instantaneous value of the desired ZMP to a second dynamic model that expresses the relationship 
between the movement of the robot and the ZMP, and for calculating an instantaneous value of the second 
dynamic model's movement; 

d. model movement difference calculating means forcalculating a difference between the instantaneous value 
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of the first dynamic model's movement and the Instantaneous value of the second dynamic model's movement; 

e. first correction amount calculating means for calculating a first correction amount based on the difference 
such that the difference approaches zero; 

f. second correction amount calculating means for calculating a second correction amount based on the dif- 
ference such that the difference approaches zero; 

g. first model input correcting means for additionally inputting the calculated first correction amount to the first 
dynamic model; and 

h. second model input correcting means for additionally inputting the calculated second correction amount to 
the second dynamic model; 

and determines at least one of an output of the first dynamic model and an output of a second dynamic model 
as a desired instantaneous values of the desired movement. 

44. A system according to any of claim 7 to 37, 42 and 44, further including: 

a. a second perturbation model that expresses a dynamic relationship between perturbation of the floor reac- 
tion force and perturbation of the movement of the robot; 

p. third feedback amount calculating means for calculating a third feedback amount based on at least one of 
a quantity of state of the second perturbation mode! and a quantity of state of the dynamic model; 
y. second feedforward amount calculating means for calculating a difference between the desired instantane- 
ous value of the determined desired floor reaction force orthe desired ZMP, and the provisional instantaneous 
value of the desired floor reaction force orthe desired ZMP to input, and for calculating a second feedforward 
amount such that the difference decreases; and 

5. third desired movement correction amount calculating means for inputting a sum of the third feedback 
amount and the second feedforward amount to the second perturbation model to calculate a third correction 
amount of the desired movement. 

45. A system according to claim 44, wherein the third desired movement correction amount calculating means calcu- 
lates the third correction amount of the desired movement, and calculates a third correction amount of the desired 
floor reaction force orthe desired ZMP by adding a sum of the calculated third feedback amount and the second 
feedforward amount, to the difference between the desired instantaneous value of the determined desired floor 
reaction force or the desired ZMP, and the provisional instantaneous value of the desired floor reaction force or 
the desired ZMP 

46. A system according to any of claims 13 to 16, 20 to 23, and 30 to 32, wherein the perturbation model comprises 
an inverted pendulum. 

47. A system according to claim 44 or 45, wherein the second perturbation model comprises an inverted pendulum. 

48. A system according to any of claims 1 to 47, further including: 

e. desired motion parameter correcting means for determining or correcting a parameter of desired motion 
based on a quantity of state of the dynamic model. 
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